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ABSTRACT 


There  existed  a  i eed  for  an  interactive  program  that 
would  provide  the  assr  assistaii:;3  in  solving  applications  of 
linear  control  theory.  The  Linsar  Control  Program  (LINCON) 
and  its  user's  guida  satisfy  this  need.  A  series  of  ten 
in-eractive  programs  are  presented  which  psrinit  the  user  to 
carry  out  analysis,  design  and  simulation  of  a  broad  class 
of   linear   control   problems. 

LINCON  consists  of  two  groups:  matrix  manipulation, 
transfer  function  aii  tine  response  programs;  and  modern 
controls  programs.  Examples  for  each  ar<=  rforked  within  each 
terminal    session   section. 
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I.   INTRDOUCTION 

The  purpose  of  this  thesis  was  to  update  an  existing 
program  which  proviies  assistance  in  solving  computational 
problems  associated  with  the  stjiy  and  application  of  linear 
control  theory.  Ths  Linear  ^Datrols  Program  (LINCON)  was 
first  developed  by  Mslsa  [  1]  and  adapted  for  batch  use  a-c 
NPS  by  Desjardins  [2].  Alth^agh  the  original  intent  of 
this  thesis  was  simply  to  take  Desjardins*  adapted  version 
of  Melsa's  LINCON  and  further  adapt  it  by  making  it 
interactive,  LINCON  soon  began  to  grow  as  other  routines 
were  incorporated,  as  will  be  nDted,  until  its  present  form 
was  achieved. 

LINCON,  as  such,  is  a  higi  level  applications  software 
system  made  up  of  i  large  number  of  program  tools  for 
interactive  analysis,  design  ani  simulation  of  a  broad  o lass 
of  linear  control  problems.  With  LINCON,  users  can 
concentrate  on  thsir  speciaiiz2d  applications  rather  -han 
systsffl  design  and  routine  program  development,  thereby 
saving  valuable  time. 

It  is  assumed  that  the  reader  is  familiar  with  -he  basic 
concepts  of  linear  control  theory  as  may  oe  obtained  from 
any   one   of  a   number   of   available   textbooks   (see   the 


bibliography).  \s  such,  tha  LINCON  subprograms  are 
presented  in  a  usec-DC iented  fashion.  First,  their  purpose 
and  some  general  rules  that  may  apply  are  given;  then  the 
input  requirements  are  presented  and  the  expected  outputs 
are  described.  Examples  for  ea:h  are  worksi  cut  including  a 
copy  of  the  terminal  session  and  the  final  results. 


10 


rr  .   SYSTEM  OVERVIEW 

During  LINC0N*3  latest  development,  underlying 
guidelines  called  for  concepts  which  accounted  for  the  needs 
of  the  computer  system,  the  programmer,  and  the  user. 

The  guidelines  followed  during  this  latest  development 
stage  were: 

(1)  Operation  of  the  systsm  should  be  in  an  on-line 
interactive  aode  such  thar  data  oan  be  easily  input 
to  (or  output  from)  tha  system  and  readily  accessed 
for  verification,  examination,  and  processing. 

(2)  Program  devalopmsnr  saould  be  in  a  high-level 
language  in  order  to  facilitate  software 
imp lementat ioi  and  promote  machine  independence. 

(3)  The  software  should  b=  nodular  in  structure  so  that 
programs  oaa  bs  modified  or  inserted  without 
affecting  existing  programs. 

{^)  Programs  shoild  be  iivoked  by  means  of  logical 
procedures  or  ccmmanis  which  miniaize  interaction 
time  and  whioh  are  ussr-oriented  so  that  people  can 
operate  the  system  witliout  first  becoming  computer 
ex  p  ert  s . 
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A.  INTERACTIVE    OPERATION 

The  applications  of  LINC3N  are  focused  on  interactive 
processing.  Experisace  has  shown  that  interactive  on-line 
communication  has  man/  advantages  in  a  research  environment 
because  it  offers  the  opportunity  to  make  observations  and 
select  alternate  courses  of  action  in  a  more  flexible  manner 
than  with  batch  procBssing  [3].  LINCON  1=  organized  around 
a  collection  cf  inter-relatsd  command  programs,  each  of 
which  performs  a  specified  fun::tion  and  can  be  executed  by 
means   of   a    simple   keyboard    initiation   sequence. 

B.  HIGH    LEVEL    LAN3UA3E 

An  important  feature  in  the  design  of  LINCON  is  tha-  it 
was  implemented  i.i  a  high  level  language.  Program 
development  in  assemoly  languagi  is  more  time  consuming  and 
results  in  system  dependent  software. 

LINCON  is  programmed  in  ANSI  standard  FORTRAN  and 
follows  the  conventions  of  FORTRAN  IV.  FORTRAN  has  been 
found  to  be  a  useful  Language  f^r  several  reasons: 

(1)  Since  some  form  of  FOEITRAN  is  available  on  most 
computers,  LINCON  is  highly  portable  from  one 
computer  to  another.  A  FORTRAN  based  system  is 
helpful  for  importing  programs   as  well  as  exporting 


them.  Of  course,  FORTRAN  compilers  don't  all  follow 
the  same  standards  so  there  can  still  be 
difficulties. 

(2)  FORTRAN  is  a  simple  ea^agh  language  that  relatively 
complex  programs  can  be  implemsated  in  a  short 
period  of  time.  Most  scientific  and  research 
personnel  know  FORTRAN  sufficiently  well  to  write 
their    own  programs   if   nscassary. 

(3)  Algorithms  cai  be  testei  and  implemented  in  FORTRAN 
and  later  convertBd  to  issembly  language  versions  if 
more  speed  and  afficiincy  are  accessary.  This 
procedure  has  the  further  benefit  of  aiding 
portability  such  that  =ven  if  parts  have  been 
converted  to  assembler,  equivalent  FORTRAN  versions 
are  availabla. 

C.        MODULAR    SOFTWARE 

Overall  system  flexibilty  is  achieved  by  means  of 
modularity.  LINCON  is  actually  inade  up  of  a  large  number  of 
independent  command  programs.  Zach  command  program  stands 
on  its  own  with  thr  ability  to  take  sona  form  of  input, 
possibly  supplied  by  some  previous  command,  and  generate 
some  form  of  output,  possibly  to  be  us=d  by  a  follow-up 
command. 
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D.  USER-ORIENTED    OPERATION 

An  important  aspsct  in  this  modification  of  LINCON  was 
to  make  the  commands  ussr-orisnted  so  that  operating  the 
system  does  not  raquire  aci  engineering  or  computer 
background.  This  was  achiavai  with  a  standard  terminal 
keyboard  by  using  phonetic  characters  which  relate  to  the 
function  which  the  command  is  to  perform.  A  good 
combination  of  brevit/  and  clarity  is  built  into  LINCON  to 
avoid  having  to  push  extra  buttons  on  the  keyboard  while  at 
the  same  time  preventing  ambiguity. 

E.  INPUT    HESTRICTIOSS     AND    LIMirATIONS 

Although  the  inpit  requirenents  are  fully  described  in 
the  presentation  of  each  prograa,  there  are  several  input 
format  similarities  ised  by  all  of  them.  For  ease  of  use, 
and,  more  honestly,  for  ease  of  programming,  most  of  the 
data    input    is    grouped    in   the    sane    arrangement. 

The  first  input  of  every  program  is  used  to  identify  the 
problem  for  reference  ani  for  output  data.  A  maximum  of 
twenty        alpha-numerio      characters        can        be      used.  This 

restriction  was  not  a  system  limitation  but  a  programmer 
decision. 
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The  next  input  ::Dmmon  to  all  programs  is  the  dimension 
of  the  plant  matrix  ^r  k  matrix.  The  format  is  II  which 
would  normally  restrict  the  user  to  a  maximum  matrix  size  of 
9x9,  however,  due  to,  again,  a  programmer  decision,  a 
dimension  size  not  to  exceed  B  is  requested-  The  reasoning 
behind  this  was  due,  in  part,  to  the  printer.  The  NPS 
printer  is  capable  ol  printin;  133  charac-cers  on  a  line. 
Since  the  output  format  to  the  printer  is  8E16.6  -his 
naturally  limits  one  to  8  numbers  per  line.  Six  places  are 
normally  considered  iscessary  fDr  good  accuracy.  A  solution 
that  would  have  lead  to  an  unlimited  matrix  size  would  have 
been  to  incorporate  a  "wrap  around"  routine  within  the 
program.  After  attempting  this  it  was  decided  the  results 
were  just  too  difficult  to  read. 

Matrices  are  entired  one  slement  at  a  time  beginning 
with  element  1,1  and  continuing  across  the  row.  The  next  row 
is  then  entered,  and  the  process  continues  until  all 
elements  have  been  entered.  Aftrr  the  matrix  is  entered,  the 
complete  rn.atrix  is  ai  tomaticaliy  brought  to  the  screen  for 
review  and  possible  correctioQ.  If  a  changs  to  the  matrix  is 
desired  the  user  siaaly  enters  the  row  number  and  column 
number  without  a   separating  conma.   For  example,    35  would 
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indicate  the  element  in  row  3  and  column  5.  After  being 
prompted  the  ::hangs  is  entered.  A  review  of  the  matrix  is 
again  screened.  The  user  is  again  prompted  for  any  possible 
changes.  This  procedure  contiaues  until  all  changes  have 
been  made. 

Any  special  reguirements  or   limitations  will  be  brought 
to  the  user's  attentio-n  within  saoh  progran  presentation. 
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III.       MATRIX    M&NI£II;AT|QN,    TRANSFER    FUNCTION    AND    TIMS 

HESPDNSS    P^DGEAMS 

A.       INTRODUCTION 

In  this  chapter  four  prograus  are  discussed  which  may  be 
used  for  the  analysis  and  design  of  linear  control  systems 
represented   in   state   variable   fDirm    as 

x(t)     =   Ax(c|     +    buCt)  (3-.  A-1) 

u  (t)     =  Krr(t)    -   k'^xCti  ]  (3.  A-2) 

y  (t)     =   c'^x(t)  (3.  A-3) 

The  first,  BASMAT,  is  tie  Basic  Matrix  manipulation 
program  which  is  ised  for  computing  the  determinant, 
inverse,  characteristic  polynonial,  and  eigenvalues  for  a 
square  matrix  A.  Ii  addition,  BASMAT  will  calculate  the 
state  transition  matrix  and  the  PHI  (s)  matrix.  The  second 
program,  PRF'EXP,  calculates  the  partial  fraction  expansion 
of  a  polynomial.  The  third  pcogram,  ROOTS,  calculat.es  the 
roots  of  a  polynomial.  The  fourth  program  is  used  for 
determining  the  time  response  of  linear  control  systems. 
RTPZSP  will  determine  the  ratio-^.al  time  response  of  a  sys-em 
in  closed-form  provided  that  the   input  function  r(t)   has  a 
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rational  time  response  and  that  there  be  no  repeated 
eigenvalues  in  the  cDibination  of  the  system  and  input.  It 
should  be  noted  heca,  and  will  be  again  in  the  actual 
discussion  cf  the  program,  that  by  setting  i:  (t)  and  K  equal 
to  zero,  unforced  aad  open-loop  systems  may  be  studied, 
respectf  ully- 
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B.   BASIC  MATRIX  PR03RAM  (BASMAI) 

Given   the   plant   matrix  k,         BASMAT   can   compute   the 
following: 

(1)  the  determinant  of  A,  d3t  A 

(2)  the  inverse  of  A,  A-* 

(3)  the  characteristic  polyaomial,  det(sI-A) 

(4)  the  eigenvalues  of  the  characteristic  polynomial, A 

(5)  the  state  transition  aatrix,  §(t)  =  exp  (At) 

(6)  the  PHI(s)  matrix,  f(s)  =  (sI-A)-i 
1.   Ter  aiinal  Session  Sxamgli 

This  section  contains  a  terminal  session  for  a 
specific  problem.  Commands  =ntered  by  the  user  are  in 
lower  case.  All  Df  BASMAT's  capabilities  will  be  utilized 
beginning  with  following  plant  narrix: 


A  = 


line on 

EXECUTION  BEGINS... 
LINCON  CONSISTS  OF  THE  FOLLOiJINS  S'JBPROGRA  JIS : 

BASIC  MATRIX  MANIPULAIION  -  <3ASMAT> 

RATIONAL  TIMS  RESPONSE  -  <RrRESP> 

STATE  VARIABLE  FEEDBACK  -  <3rVAR> 

CONTROLLABILITY  .\ND  OBSERVABILITY  -  <OBSCON> 

LUENBERGE3  OBSERVER  -  <LUEN> 

OPTIMAL  CONTROL/KALMAN  FILIiRS  -  <RICAri> 

DISCRETE  TIME  SALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPrCON> 

PARTIAL  FRACTION  EXPANSION  -  <?RFEXP> 

ROOTS  OF  A  POLYNOMIAL  -  <RODrS> 
TO  USE  ONE  OF  THE  SJ3 PROGRAMS  5NTER  THE  NAME  BETWEEN  THE 
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"l.O 

0,0 

0.0^ 

0.0 

-2.0 

1.0 

0.0 

-0.5 

1.0 

L 

J 

SYMBOLS    <    >. 
basmat 

BASMAT     PROVIDES    llATEIX    MANIPULATION    TO    SOLVE 
FOR    DETERMINANTS,     INVERSES,    STATE    TRANSITION    AND 
PHI(S)      MATRICES,    EIGENVALaES,     AND    CHARACTERISTIC 
POLYNOMIALS. 

FIRST    ENTER    THE    PROBLEM    IDE!?riFICATION 
(*NOT    TO    EXCEED    23    CHARACTERS*) 
thesis   exaicple 

NOW    ENTER    THE    DIMENSION    OF    THE    A    MATRIX     (UP    TO    8) 
3 

THE    ELEMENT    A(1  ,1)  = 
1.0 

THE    ELEMENT    A(1,2)  = 
0.0 

THE    ELEMENT    A(1  ,3)  = 
0.0 

THE    ELEMENT    A(2,1)  = 
0.0 

THE    ELEMENT    A(2,2j  = 
-2.0 

THE    ELEMENT    A(2,3|  = 
1.0 

THE    ELEMENT    A(3,1)  = 
0.0 

THE    ELEMENT    A(3,2|  = 
-0.5 

THE    ELEMENT    A  (3,  3 1  = 
1 .  0 


THE    A     MATRIX 

1.  COE^-00      0.3  3.3 

0.0  -2.30E  +  00  1.30E  +  00 

0.0  -5.30E-01  1.30E+00 

DO    YOU    WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

DO    YOU     WANT    TO    CALCULATE    THE    DETERMINANT? 

THE    DETERMINANT    DF    THE    MATRIX 
-1.  50E+00 

ARE    YOU    SATISFIED     WITH    THE    RESULTS? 
DO    YOU     WANT    THE    DETERMINANT    PRINTED? 
DO    YOU     WANT    TO    CALCULATE    THE    INVERSE? 
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THE    INVERSE   OF    THE    MATRIX 

1.00E  +  00      0.3  0.3 

0.0  -6.57E-31       5.S7E-01 

0.0  -3.33E-01       1.33E  +  00 

ARE    YOO    SATISFIED     WITH    THE    RESULTS? 

y 

DO    YOa     WANT    THE    INVERSE    PRINTED? 

y 

DO  YOU  WANT  TO  CALCULATE  THE  PHI  (S)  MATRIX? 

y 

*********************************************************** 

THE    MATRIX    COEFFICIENTS    3F    THE    NUMERATOR    OF    THE 
PHI(S)     MATRIX 

THE    MATRIX    COEFFICIE!JT    OF    3**2 

1.  GOE■^00      0.3  0.3 

0.0  1.00S  +  00      0.3 

0.0  0.3  1.30E+00 

THE    MATRIX    COEFFICIENT    OF    3**1 

1.  OOE  +  00      0.  3  0.3 

0.0  -2.00E+00       1.30E+00 

0-0  -5.3GE-01       1.30E  +  00 

THE    MATRIX    COEFFICIENT    OF    3**0 

-1-50E>00      0.3  3.3 

0.  0  I.OOE^OO    -1.33E  +  00 

0.0  5.30E-01    -2.00E  +  00 

ARE    YOU    SATISFIED     WITH    THE    RESULTS? 

A    NO    RESPONSE    WILL     GIVE    Y3U    THE    OPTION    TO    MAKE 

CHANGES    TO    THE    A    MATRIX. 


y 

y 


DO  YOU  WANT  A  PRINTOUT  OF  THE  RESULTS? 

DO  YOU  WANT  TO  CiLCULATE  THE  CHARACTERISTIC  POLYNOMIAL? 


y 

4c«:^:«c:«eXeic4E««:4e3Me4c:ae:^4c*:k:4c*4c  ************  4t*  *****************  ***  *** 

THE    CHARACTERISTIC    POLYNDMI AL-IN    ASCENDING    POWERS    OF    S 
1.50E+00    -2.50E+00       3.3  1. OOE+00 

ARE    YOU    SATISFIED     WITH    THE    RESULTS? 

y 

DO  YOU  WANT  THE  ::■!  ARAC  TERIS  TI C  POLYNOMIAL  PRINTED? 

y 

DO  YOU  WANT  TO  CALCULATE  THE  EIGENVALUES? 
**********************************  **********************  *** 
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THE    EIGEHVAiaES    3F   THE    A    MMRIX 
REAL   PART    IMA3.    PART 

8.23E-01      O.D 

-1.82E+00      0.3 

1.  00E-«-00      0.3 

ARE  YOU  SATISFIED  WITH  THE  RESULTS? 

y 

DO  YOU  WANT  THE  EIGENVALUES  PRINTED? 

y 

DO  YOU  WANT  TO  CALCULATE  THE  STATE  TRANSITION  MATRIX? 

y 

THE    ELEMENTS    3F    THE    STATE    TRANSITION    MATRIX 

THE    MATRIX    COEFFICIENT    OF    SXP (       8.23E-31)T 

0.0  0.3  3.3 

0.0  -6.59E-32       3.78S-01 

0.0  -1.39E-01       1.37E  +  00 

THE    MATRIX    COEFFICIENT    OF    EXP(    -1.32E  +  00)T 

0.0  0.3  3.3 

0.  0  1.07E  +  00    -3.73S-01 
0.0  1.39E-01    -5.59E-02 

THE    MATRIX    COEFFICIENT    OF    SXP(       1.00E+30)T 

1.  QOE^OO      0.  3  3.3 

0.  0  -2.26E-06       2.  35E-06 

0.0  -5.36E-07      1.37E-06 

ARE    YOU    SATISFIED     WITH    THE    RESULTS? 

A    NO    RESPONSE    wILL    GIVE    THE    DPTION    TO    MAKE 

CHANGES    TO    THE    A    MATRIX. 


DO    YOU     WANT    A    PRINTOUT    OF    THE    RESULTS? 

THIS    CONCLUDES    THE    BASIC    MATRIX    MANIPULATION    PROGRAM 
(BASMAT). 

ANALYSIS   IS    COMPLETE.    DO    YOJ    WANT    TO    RUN    LINCON    AGAIN? 
n 

LINCON     IS    NOW    TERMINATED. 

The      30iiiput9r      rasulr-s      are      shown      in      Appendix      A. 

Interpretation    of   the    de-erraina  :it ,         inverse    and   eigenvalues 

are    straightforward.      The   PHI(sj       matrix    is    a    combination   of 

the      numerator    coefficients      and    characteristic      polynomial. 

The  results    can    be    interpreted    is 
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1(3)      = 


s2-2.5s^1 .5 


32fs-1.5  0.0  0.0 

D-0  s2-2.0s+1  s-1 

0.0  -O.Ss-t-O.S  S2  +  S-2 


and,      simlarilyr        the    fifth      tsrm   of      tha   state      transition 


matrix   is 


|(t)    =      -0.067exp(0.82t) -H.OTaxp  (-1.82t| -2.26x10-6exp  (t) 
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C.       PARTIAL    FRACTION    EXPANSION    PROGRAM     (PRFEXP) 

PRFEXP    can    calculate  a      partial   fractiDn   expansion  given 
a  rational    ratio  of   two   polynomials   in   the    form 

N(  =  ) 

G(3)     =    K (3.C-1) 

D(5) 

where    K   =  the  input  function  gain, 
a  constant 

N  (s)  =  n^  +  n^^s  ♦  nj  s2  +  . , .  +  s*^ 

and   D(s)  =  d,  +  d^  s  +  dj  s2  +  ...  -f  s'' 

The   numerator    and   denominator      coefficients   must   be   arranged 

1  f 

so   that      th€  coefficients    of   3        and   s      are    each      unity    with 

p   >   q    >  0.      The   outpats   of    tha    program   are 

(1)  the  numerator  gain 

(2)  the  numerator  polynomial  and  its  rocts;  roots  are 
considered  equal  if  th=ir  real  and  imaginary  parts 
do  not  differ  by  more  tian  0.005. 

(3)  the  denominator  polynomial  and  its  roots;  multiple 
roots  are  listed  once,  along  with  izs   multiplicity 

(U)  the  numerator  cceffici=nts  (residue  matrix)  are 
listed  in  the  same  ordB-  as  the  ienominator  roots; 
the  first  coefficient  in  any  row  of  the  matrix  is 
the  first-orisr  term  corfficient. 
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1"   I§I.JiEal  Ssssion  Examgls 

The  partial   fractioQ  sxpansion   Df   the   following 
rational  polynomial  is  to  be  performed: 


14  (32+2)  (S+1) 

G(s)  = 

2s*^5s3*2s-«-5 


Putting   the   polynomial    in   a   usaDls    form   yislds 

7  (s3+s2*2s  +  2) 
G  (s)     =    

s*  +  3s3+sf2.5 


lincon 

EXZCU'^ION    EEC^NS.. 

LINCON    CONSISTS    OF'THE    FDLLOWI^IG    SUBPROGRAMS: 

BASIC    MATRIX    MANIPULAnON    -    <3ASMAT> 

RATIONAL   TIME    RESPONSE    -    <RrRESP> 

STATE    VARIABLE    FEEDBACK    -    <3r7AR> 

CONTROLLABILITY    AUD    0BSERVA3 I LITY    -    <OBSCON> 

LUENBERGER    OBSERVER    -    <LySN> 

OPTIMAL    CONTROL/KALMAN     FILTERS    -    <RICAri> 

DISCRETE   TIME    KALMAN    FILTER    -    <KALMAN> 

OPTIMAL    CONTROL    -     <OPrCON> 

PARTIAL    FRACTION    EXPANSION*    -    <PRFEXP> 

ROOTS    OF    A    POLYNOMIAL    -    <RODrS> 
TO    USE    ONE    OF    THE    SUBPROGRAMS    ENTER    THE    NAME    BETWEEN    THE 
SYMBOLS    <    >. 
prf exp 

FRFEXP     IS    USED    T3    DETERMINE    THE    PARTIAL 

FRACTION    EXPANSION    OF    THE    RAIIO    OF    TWO    POLYNOMIALS. 

FIRST    ENTER    THE    PROBLEM    IDENTIFICATION 
(*NOT    TO   EXCEED    23     CHARACTERS*)  . 
thesis    exa  iple 

ENTER    THE    INPUT    F J  NOTION    GAIN--K. 
7. 

THE    INPUT    FUNCTION    GAIN 
7.  OOE  +  00 

DO    YOU     WANT    TO    CHANGE   THE    VALUE    OF   THE    GAIN? 
n 

ENTER    THE    NUMERATOR    3i     POLYNOMIAL    COEFFICIENT    OR 
FACTORED   ROOT    FORM.     FIRST    ESTER    EITHER    THE    LETTER    P 
FOR    POLYNOMIAL    COEFFICIENT    FORM       OR    THE    LETTER    F    FOR 
FACTORED   ROOT    FORM . 
P 
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ENTER    THE    NUMERATDR    POLYNOMIAL    ORDER. 
3 

THE    POLYNOMIAL    CDEFFI^IENTS    MUST    BE    ENTERED    IN    ASCENDING 
ORDER   OF  S. 

♦  ♦WARNING — THE    HIGHEST    ORDER    COEFFICIENT    MUST    BE    UNITY.* 
DO    YOU     NEED    TO    C3ANGE   THE    I!JPUT    FUNCTION    GAIN    TO    SATISFY 
THIS    REQUIREMENT? 
n 

ENTER    THE    POLYNOMIAL    COEFFIZIENTS    IN    ASCENDING 

ORDER    OF   S. 

C0EFF(1)= 

2. 

C0SFF(2)= 
2. 

C0EFF(3)= 
1. 

C0EFF(4)= 
1. 

NUMERATOR    COEFFIZIENTS    -    I.^     ASCENDING    POWERS    OF    S 
2.00E  +  00       2.00E-«-03       1.00E  +  00       1.00E  +  00 

NUMERATOR    ROOTS    ARE 

REAL   PART    IMA3  .    PART 
,0.0  -1.^  1E  +  00 

0.0  l.^ilE+OO 

-1.  COE-t-00      0.0 

ENTER    THE    DENOMINATOR    BY    POLYNOMIAL    COEFFICIENT    OR 
FACTORED   ROOT    FORM.    FIRST    EIJTER    EITHER    THE    LETTER    ?    FOR 
POLYNOMIAL    COEFFICIENT    FORM    OS    THE    LETTER    F    FOR    FACTORED 
ROOT    FORM. 


ENTER    THE    DENOMIflATOR    POLYNOMIAL    ORDER. 

THE    POLYNOMIAL    COEFFIZIENTS    MUST    3E    ENTERED    IN    ASCENDING 
ORDER    OF   S. 

♦♦WARNING — THE    HIGHEST    ORDER    COEFFICIENT     MUST    BE    UNITY.* 
DO    YOU     NEED    TO    CHANGE    THE    IIJPUT    FUNCTION    GAIN    TO    SATISFY 
THIS    REQUIREMENT? 
n 

ENTER    THE    POLYNOMIAL    COEFFICIENTS    IN    ASCENDING 
ORDER    OF   S. 
C0EFF(1)= 
2.5 

C0EFF(2)= 
1. 

C0EFF(3)= 

C0EFF(4)= 

3. 

C0EFF(5)= 
1. 
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DENOMINATGR    COEFFICIENTS    -    IN    ASCENDIN3    POWERS    OF    S 
2.50E+00       1.00E+00      3.0  3.00E>00      1.00E+00 

DENOMINATOE    ROOrS     ARE 

REAL   PART    IMA3.    PART  HIJLTIPLICITY 
-3. 019E+00    0.3  1 

-9.  128E-01    0.0  1 

4.658E-01-8.308E-3  1  1 

a.658E-01    8.308E-01  1 

RESIDUE   MATRIX    -    REAL    PART 
5.  81E  +  00 
3.  17E-01 
a.  36E-01 
a.  36E-01 

RESIDUE   MATRIX    -     IMA3.     PART 
-2.  05E-07 

0.  0 

2.  C6E>00 
-2.  C6E+00 

THIS    CONCLUDES    THE    PARTIAL    FRACTION    EXPANSION    PROGRAM 
(PRFEXP) . 

DO    YOU     WANT    TO    RUN    THE    PROGRAM    AGAIN? 
n 


ANALYSIS    IS    COMPLETE.     DO    YOJ    WANT    TO    RUN    LINCON    AGAIN? 


n 


LINCON     IS    NOW    lERMINAIED. 
The   results      are  shown      in   Appendix      B.         Interpretation      of 

these   results    are: 


S-5.81+J0  s-0.32  3-0.4U-j2.06  s-O. U4+ j2 . 06 

G{s)     = -—    + * + 

s+3.02  5+9.13  3-0.U7-t-j0.83  s-0.U7-j0.83 
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D.       POLYNOMIAL    ROOTS    PROGRAM    (R3DTS) 

ROOTS    can    calculate   the    roots      of    a    polynomial   of   degree 
less   than   or  equal   tD    eight.    Siirea    a   pclynomial    in   the   form 

■J 

P  (s)     =    p,    +    Pj.  s   «•    P3  32    +    .  . .    +    s  (3-D-1) 

the  coefficient  of  3*  must  be  unity.  The  program  oatput 
lists  the  polynomial  coefficients  for  reference  and  the  real 
and   imaginary    roots. 

1.      Terminal.  Session   Exampls 

The   following    polynomial    is   to    be   factored: 

P(s)     =    -5s3    f     15s2    -    25.5s    +    4 

Putting  the  polynomial  in  the  required  fom  yields 
?(s)  =  s3  -  3s2  *•  5.I3  -  0,8 

lincon 

EXECUTION     BEGINS 

LINCON   CONSISTS    OF    TtiE    FOLLO;^IMG    SUBPROGRAMS: 

BASIC    MATRIX    MANIPULATION    -    <BASMAT> 

RATIONAL   TIME    RESPONSE    -    <RTRESP> 

STATE    VARIABLE    FEEDBAZK    -    <3TVAR> 

CONTROLLABILITY    AND    OBSERVABILITY    -    <OBSCON> 

LUENBERGER    OBSERVER    -    <LUSN> 

OPTIMAL    CONTROL/KALMAN     FILTERS    -    <RICAri> 

DISCRETE   TIME    KALMAN    FILTER    -    <KALMAN> 

OPTIMAL    CONTROL    -    <OPTCON> 

PARTIAL    FRACTION    EXPANSION    -     <?RFEXP> 

ROOTS    OF    A    ?0LYND)1IAL    -    <RDDT5> 
TO    USE    ONE    OF    THE    SJB PROGRAMS    ENTER    THE    NAME    BETWEEN    THE 
SYMBOLS    <     >. 
roots 
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ROOTS  IS  USED  TO  FIND  THE  RDDTS  OF  A  POLYNOMIAL  OF 
DEGREE  LESS  THAN  DR  EQ JAL  TD  EIGHT. 

FIRST  ENTER  THE  PROBLEM  IDENTIFICATION 
(NOT  TO  EXCEED  23  CHARACTERS)  . 
thesis  exa  irple 

ENTER  THE  ORDER  3F  THE  SYSTEM  (UP  TO  8). 
3 

ROOTS  OF  A  POLYNOMIAL 

ENTER  THE  POLYNOMIAL  COEFFICIENTS  IN  ASCENDING 

ORDER  OF  S. 

♦  ♦WARNING  — THE    HIGHEST    ORDER    COEFFICIENT    MUST    BE    UNITY.* 
C0EFF(1  )  = 
.8 

C0EFF(2)= 
5.1 


C0EFF(3)= 

C0EFF(U)= 

POLYNOMIAL    COEFFICIENTS    -    IN     ASCENDING    POWERS    OF    S 
8.00E-01      5.10E-H00      3.3DE  +  00       1.00E■^00 

THE    ROOTS     ARE  REAL    PART  IMAG.    PART 

-1.41EfOO  1.62E+33 

-l.aiEfOO  -1.62E<-00 

-1.7'4E-01  0.0 

THIS  CONCLUDES  THE  POLYNOMIAL  ROOTS  PRDGRAM. 

DO  YOU  WANT  TO  RUN  THE  PROGRAM  AGAIN? 
n 

ANALYSIS  IS  COMPLETE.  DO  YOJ  WANT  TO  RUN  LINCON  AGAIN? 
n 

LINCON  IS  NOW  TERMINATED. 

The   results    shown   i.i    Appendix   C    are   easily 

interpreted . 


29 


E.   RATIONAL  TIME  RESPONSE  PROGRAM  (RTRESP) 

The  time  responsa  in   clDssi  form  of  a   linear  comirol 
system  described  by  Egs.   (3.!i-1),   (3.A-2I   and  (3.A-3)   is 

calculated  by  this  program.  The  user  must  define  the 
initial  conditions  x(D)  and  the  rational  Laplace  transform 
of  the  scalar  forcing  function  r(t).  The  theoretical 
concepts  involved  in  the  develDpoient  of  the  computer  codes 
are  described  by  Melsa  [  1  ]• 

'' •   In  p  ut  Restrictions  And  Limitations 

Enrer  the  following  ia  F  format  (floating  point)  : 

1)  the  elements  of  tha  plant  matrix  A 

2)  the  control  vector  b 

3)  the  output  vector  c 

U)  the  feed  backback  co=fficent  vector  k 
5)  the  controller  gain  ^ 


and 


6)     the    initial    conditions    vector   x(0) 
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The   rational   Laplace   transform   of   the    input   function 
must   be   in    the    fori 


X -•  ■     -"'=' 


[r(t)  ]  =  Ms)  =  G (3.  E-1) 

D(3) 

where   3   =  the  input  function  gain, 
a  constant 

N  (s)  =  n,  -♦•  n^s  f  n^ss  +  ...  +  s^ 

and   D(s)  =  d,  +  d,,  s  ♦  djS^  +  ...  +  s** 


The  numerator  and  ienominanor  coefficients  must  be  arranged 
so  that  the  coeffici9nts  of  s*^  and  s**  are  each  unity  with 
p  >  g  >  0.  Due  to  programmir.j  limitations  ii  is  necessary 
that  the  order  of  ths  system  plus  the  dioaension  of  D  (s)  be 
less  than  or  equal  'd  ten. 

Upon  entering  the  input  function  gain,  the  user  next 
has  the  option  to  =nter  the  lumerator  and  denominator  in 
either  polynomial  cr^efficient  CDrm  or  fa::tored  root  form. 
With  the  factored  root  form  entsr  the  real  part  of  the  root 
as  negative  if  it  lias  in  the  left  half  plane  and  just  the 
magnitude  of  the  imaginary  part. 
2-   Terminal  Srssion  Hxamgl? 

This  sectioa  contains  a  -erminal  session  for  a 
specific  sxample,  CDnmands  entered  by  the  user  are  in  lower 
case.  The  RTR2SP  prDgraca  will  determine  the  time  response 
form  of  the  closed-loop  system 
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'^I.O  0.0  0.0  0.0 

x(t)  =  0.0  -2.3  1.0  x(t)  +  0.0  u(t) 

0.0  -0.5  1.0  "  1.0 

C                        J  L     J 


u(t)  =  3.2{r(t)  -  [1.0   1.0   0.0]  x(t)} 
Y(t)  =  [1.0   O.a   1.0]  x(t) 

if  the  Laplace  transfDrm  of  the  iaput  function  is 

3  +  1.0 

R(s)  =  0.5   

s2  -  2.0 

and   the    initial   coaditions    ara    zero. 

Note  here  thit  tha  opan-loop  rational  t-ime  response 
may  be  calculated  by  setting  th=  feedback  coefficient  vector 
k     equal   to      a      zero   vector.  Also,         if      only   an      ini-ial 

condition    response    iz    desired,      the   input    function   gain    G  is 
set   to   zero , 

linccn 

EXECUTION  BEGINS... 
LINCON  CONSISTS  OF  I'iZ    FOLLOWING  SUBPROGRAMS: 

BASIC  MATRIX  MANIPULAPION  -  <3AS:iAT> 

RATIONAL  TIME  RESPONSE  -  <Rr3SSP> 

STATE  VARIABLE  FEEDBACK  -  <3rVAR> 

CONTROLLABILITY  A  :i  D  OBSERVABILITY  -  <OBSCON> 

LUENBERGER  OBSERVER  -  <LUEN> 

OPTIMAL  CONTROL/KALMAN  FILISRS  -  <RICAri> 

DISCRETE  TIME  KALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPrCON> 

PARTIAL  FRACTION  EXPANSION  -  <?RFEXP> 

ROOTS  OF  A  POLYNOMIAL  -  <RODrS> 
TO  USE  ONE  OF  THE  SUBPROGRAMS  ENTER  THE  NAME  BETWEEN  THE 
SYMBOLS  <  >. 
rtresp 
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ETRESP     DETERMINES    THE    TIME    RESPONSE    OF    A    LINEAR 
FEEDBACK   CONTROL    SYSTEM.    THIS    PROGRAM    HILL    GIVE    A 
CLOSED-FORM    EXPRESSION    FOR    THE    TIME    RESPONSE. 

FIRST    ENTER    THE    PROBLEM    IDENTIFICATION 
(NOT    TO    EXCEED    23     CHARACTERS)  . 
thesis   exa  iple 

ENTER    THE    ORDER    OF    THE    SYSTEM     (OP    TO    8). 
3 

ENTER    THE    ELEMENIS    OF    THE    PLANT    MATRIX--A. 

.     „A(1,1)  = 

1-0 

n     ^A(1,2)  = 

0.0 

A  ( 1 ,  3)  = 
0.0 

0.0 

n    M2.2)  = 
-2.0 

A  (2,3)  = 
1.0 

0.0 

.    A  (3,  2)  = 

-0.  5 

A  (3,3)  = 

1.0 

THE    A     MATRIX    (PLANT    MATRIX) 

1.00E  +  0C       0.3  0.3 

0.0  -2.00E+00       1.DOS+00 

0.0  -5.30E-01       1.03E  +  00 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT  (S)     OF    THE    MATRIX? 
n 

ENTER    THE    ELEMENTS    OF    THE    CONTROL    VECTOR--B. 

B(1)  = 

0.0 

n    .3<2)  = 

0.0 

1-0 

THE    B     MATRIX     (CONTROL    VECTDR) 

0.  0 
0.  0 
1. OOE+00 

DO    YOU     WANT    TO    CHANGS    ANY    ELEMENT  (S)     OF    THE    MATRIX? 
n 
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ENTER    THE    ELEMENIS    OF    THE    DOIPaT    VECTOR — C. 
1.0 

1.0'^'''  = 

THE    C     MATRIX    (OQrPUT    VECTOR) 
1.  00E-«-00 

a.  cOE-01 
1 .  ooE  +  00 


n 


DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT (S)     OF    THE    MATRIX? 

ENTER    THE    ELEMENTS    OF    THE    FEEDBACK    COEFFICIENT    VECTOR    — 
FDBG. 

FDBG(1)  = 

1.0 

FDBG  (2)  = 
1.0 

^    ^FDBG(3)  = 
0.0 

THE    FEEDBACK   COEFFICIENT    VECTOR 

1. OOE+00 
1.  COE  +  00 

0.  0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT  (S)     OF    THE    VECTOR? 
n 

ENTER    THE    CONTROLLER    3AIN--K. 
3.2 

THE    CONTROLLER    5AIN 

3. 20E+00 

DO  YOU  WANT  TO  CHANGE  THE  VALUE  OF  THE  SAIN? 
n 

ENTER  THE  ELEMENTS  OF  THE  INITIAL  CONDITIONS  VECTOR  — 
X(0). 

XO  (1)  = 

0.0 

XO  (2)  = 

0.0 

XO  (3)  = 

G.O 

INITIAL  CONDITIONS  VECT0R-X(3) 

0.  0 
0.  0 
0.  0 
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DO    YOU    WANT    TO    CHANGE    ANY    ELEMENT  (S)     OF    THE    VECTOR? 
n 


ENTER    THE    GAIN    FDR    THE    RATIONAL    LAPLACE 
TRANSFORM    OF    IHE    INPUT    FlINCIION. 
0.5 

THE    INPUT    FUNCriON    GAIN    = 
5.  OOE-01 

DO    YOU     WANT    TO    CHANGE   THE    VALUE    OF    THE    SAIN? 
n 

ENTER    THE    NUMERAPOR    Bif    POLYNOMIAL 

COEFFICIENT    OR    F!1:T0RED    ROOT    FORM. 

FIRST    ENTER    EITHER    THE    LETTER    P    FOR 

POLYNOMIAL    COEFFICIENT    FORM    OR    THE    LETTER    F    FOR 

FACTORED   ROOT    FORM. 


ENTER    THE    NUMERATOR    POLYNOMIAL    ORDER. 


ENTER    THE    REAL    PART    OF    THE    R33T. 
-1.0 

ENTER    THE    MAGNIT3DE    OF    THE    IMAGINARY    ROOT. 
0.0 

NUMERATOR    POLYNDMIAL    OF    H (S)  - ASCENDIN3    POWERS    OF    S 

1.  OOE  +  00       1.00E  +  D0 

NUMERATOR    ROOTS    ARE 
REAL    PART    IMA3.     PART 
-1.  OOE  +  OO      0.3 

ENTER    THE    DENOMINATOR    BY    POLYNOMIAL 
COEFFICIENT    OR    FACTORED    RDOT     FORM. 
FIRST    ENTER    EITHER     THE    LETTER    P    FOR 
POLYNOMIAL    COEFFICIENT    FORM    3R    THE    LETTER    ?    FOR 
FACTORED    ROOT    FORM. 


ENTER    THE    DENOMI^JATOR    POLYNDMIAL    ORDER. 

THE    POLYNOMIAL    CDEFFICIENTS    MUST    BE 
ENTERED    IN    ASCENDING    ORDER    DF    S. 

WARNING— THE    HIGHEST    ORDER    COEFFICIENT    MUST    BE    UNITY 

DO    YOU     NEED    TO    CH^NGE    THE    I^PUT 

FUNCTION   GAIN    TO    SATISFY    THIS     REQUIREMENT? 


n 


ENTER    THE    POLYNOMIAL    COEFFICIENTS    IN 
ASCENDING    ORDER    DF    S. 

-2.0 

0.0 

CO  (3)  = 

1.0 


DENOKINATOP    POLINOMIAL    OF    S (S)     -    ASCENDING    POWERS    OF    S 
-2.00E-fOO      0.3  1.00E  +  00 

DENOMINATOR    ROOTS     ARE 
SEAL    PART    IMA3.     PARI 
1.aiE  +  00      O.D 
-1.aiE4-00      0.3 

**********************************  **********************  *** 

THE    riME    RESPONSE    OF    IKE    SPATE    X  (T) 

THE    VECTOR    COEFFICIENT    OF    EXP  (-5  .  OE-01 )  T*COS  (1 .  2E  +  0  0)  T 

0.0  -3.70E-01    -9.72E-01 

THE    VECTOR    COEFFICIENT    OF    EXP  (-5.  OE-01 )  T*SIN  (1 .  2E  +  0  0)  T 

0-0  -3.47E-01    -7.50E-02 

THE    VECTOR    COEFFICIENT    OF    EXP  (       1.00E^Q0)T 

0.0  0.3  2.58E-06 

THE    VECTOR    COEFFICIENT    OF    EXP  (       1.U1E+00)T 

0.0  2.67E-01       9.12E-01 

THE    VECTOR    COEFFICIENT    OF    EXP  (    -1-41E+00)T 

0.0  1.03E-01       5.33E-02 

*********************************************************** 

THE    TIME    RESPONSE    OF    THE    OUTPUT    Y  (T) 

THE    COEFFICIENT    OF  EX  ?  (    -5  .  00  E-0  1 )  T*COS  (       1.20E  +  00)T 

-1.  12E  +  00 

THE    COEFFICIENT    OF  EXP(    -5.  33  S-0  1)  T*SIN  (       1.20E  +  00)T 

-2.  1UE-01 

THE    COEFFICIENT    OF  EXP  (       1.00E  +  00)T 

2. 68E-06 

THE   COEFFICIENT    OF  EXP  (       1.'41E  +  00)T 

1.  02E  +  00 

THE    COEFFICIENT    OF  EXP  (    -1.41E  +  00)T 

1. 01E-01 

***********  ***********  ****  ******************************  *** 

THIS    CONCLUDES    THE     RATIONAL    TIME    RESPONSE    PROGRAM 
(RTRES?) 

ANALYSIS   IS    COMPLETE.        DO    YOU       WANT    TO    RUN    LINCON    A3AIN? 
n 

LINCON     IS    NOW    TERMINATED. 
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The   computer   results   shown   in   Appendix   D   are 
interpreted  as: 

X,  (t)  =  0.  0 

X,  (t)  =  -0.  37exp(-0.5t)co3n  .2t) -0.35  =  xp(-0.5t)  sin  (1  .2t) 
^      +0.67exp(1  .'^It) +0.  t3exp(-1.41t) 

X,  (t)  =  -0.  97expj[- 0.5t)CDS  n.2t) -O.OSexp  (-0,5t)  sin(1  .2t) 
^       >2.7x10-S9xp(t) +0.91exp(1.41t)  <-:5.06exp  (-1.41t) 


y(t)   =  -1 .  12exp(- 0.5t)co3  n.2t) -0.2Uxp(-0.  5t)  sin  M  .2t) 
♦  2.7x13-&3xp(t) +1.02axp  (1.41-) fO. 1exp(-1.4tt) 
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IV.       MODERN   CONrROL    PROGRAMS 

A.       INTRODUCTION 

In  this  chapter  six  programs  are  preseated  and  discussed 
which  may  be  used  for  the  analysis  and  design  of  control 
systems. 

The  first,  OBSCDN,  is  LiSrd  to  find  the  observability 
index  and  controllability  of  a  system.  The  next  two  programs 
are  used  to  desigo  Kalman  filters.  RICAII  and  KALMAN  can 
find  the  feedback  and  control  jains  necessary  to  optimize  a 
function  for  either  conrinuDus  or  discrete  systems, 
respectively.  The  list  three  pcrograms  may  be  used  to  design 
optimal  linear  control  systems.  SIVAR  is  particularly  useful 
in  the  design  of  liiear  state  variable  feedback  control 
systems.  It  may  be  used  to  calculate  both  open-  and 
closed-loop  transfer  functions  and  also  has  the  ability  to 
design  a  closed-loop  system  from  desired  transfer  function 
specifications.  LUSN  is  usrd  to  design  a  combined, 
reduced- order,  obser ver-contrDller  to  achieve  a  desired 
closed-loop  transfer  function  from  a  system  where  scie  of 
the  states  are  inaccesible,  OPTCON  will  minimize  a  given 
cost    function    producing   a   scalar    control. 
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B.   OBSERVABILTIY  INDEX  AS D  CDNT ROLLABILITY  PROGRAM  (OBSCON) 
This   program  is   used   tD   istermine  the   observability 
index  and  ccntrollabil ity  of  th=  linear  system 


x(t)  =  Ax(t)  +  Bu(t) 


(U.  B-1) 


lit)     =  Cx(t) 


(U.  B-2) 


where 


X  =   state    vector     (n-dimensional    vector) 


u   =   control   vector    ( l-dimensional    vector) 


Y  =   output   vector    (m-dimensional    vector) 


A  =    n  X    n    matrix 


B  =   n    X    1    matrix 


C  =    ffl   X    n    matrix 


The      observability      iadex 
.nteger   such  that   th?    matrix 


[C^a'c,.  ..  ,  (A^  )''-^C] 


defined   as   the   minimum 


has  rank  n.    The  above  system  is  said  to  be  controllable  at 
a   given   initial  tine   if   it   is   possible,   by   using   an 


39 


unconstrained  control  vector,  to  force  ths  sys-cem  from  an 
initial  state  of  x(0|  to  soma  other  state  in  a  finite  -ime 
interval  [  U], 

If  the  user  desires  just  the  observability  index  to  be 
calculated,  enter  ths  B  matrix  is  a  zero  matrix.  Likewise, 
if  just  the  controllib ilit y  of  che  system  is  desired,  enter 
the  C  matrix  as  a  zero  matrix.  The  unobservaDle  or 
uncontrollable  system  response  is  then  of  rourse  ignored. 

''•   IHElilt  Restrict  ions 

Other  than  the  limitations  to  the  problem 
identification,  (20  ::hara3ter  =  )  and  system  size  (8x8)  there 
are  no  restrictions  to  OBSCDN.  A  reminder  here  may  be 
helpful,  however.  Remember  to  enter  your  elements  of  the 
matrices  in  F  forma t. 

2-   Terjinal  Session  Sxaraole 

This  section  contains  a  session  for  a  specific 
problem.  Commands  eatered  by  the  user  are  in  lower  ::ase. 
The  following  system  is  to  be  tested: 


0.0  1.0  0.0  2.0  1.0 

x(t)  =  -1.0  -0.5  1.0  x(t)  f  0.0  1.0  a(t) 

0.0  0.0  1.0  "  0.0  0.0  " 

L                         J  L             J 


id 


'^  0.0  1.0  0.0 

y  (t)  =   1  .0  1.0  0.0  X  (t) 

^  -2.0  1.0  0.0  ~ 

I.  J 


lincon 

EXECUTION  BEGINS... 
LINCON  CONSISTS  OF  THE  FOLLOWING  SUBPROGRAMS: 

BASIC  MATRIX  MANIPULAIION  -  <BASMAT> 

RATIONAL  TIME  RESPONSE  -  <RrRESP> 

STATE  VARIABLE  FEEDBACK  -  <3rVAR> 

CONTROLUBILITY  AND  OBSERVABILITY  -  <03SC0N> 

LUENBERGER  0BSER7SR  -  <La2N> 

OPTIMAL  CONTROL/KALMAN  FILTERS  -  <RICAri> 

DISCRETE  TIME  KALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPrCON> 

PARTIAL  FRACTION  EXPANSION  -  <PEFEXP> 

ROOTS  OF  A  POLYNOMIAL  -  <R03TS> 
TO  USE   ONE  OF  THE  SUBPROGRAMS   ENTER  THE  NAME   BETWEEN  THE 
SYMBOLS  <  > . 
obscon 

OBSCON  DETERMINES  THE  OBSERVABILITY  INDEX  AND 
CONTROLLABILITY  OF  A  SYSTEM. 


FIRST  ENTER  THE  PROBLEM  IDENTIFICATION 
(*NOT  TO  EXCEED  20  CHARACTERS*) 
thesis  exa  irple 
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NOW,    ENTER    THE    ORDER    OF    THE    SYSTEM     (UP    TO    8). 
ENTER    THE    ELEMENTS    OF    THE    PLANT    MATRIX--A. 

A(1r1)  = 


0, 

.0 

r 

1, 

.0*'^' 

.2) 

= 

0. 

■  O^'^' 

^3) 

= 

-  ■ 

A  (2. 

1.0 

1) 

= 

_  / 

3.0 

-2) 

= 

1. 

.o''*'' 

.3) 

= 

0, 

.c^'^' 

.1) 

= 

0. 

.0*<^' 

.2) 

= 

1. 

.o**'- 

-3) 

= 

4  1 


THE    A  MATRIX    jfPLANT   MATRIX) 
0-0  1.00E+00       0.0 

-1.00E+00  -5.00E-01       1.00E  +  00 

0.0  0.0  1.00E+00 

DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    NUMBER    DF    COLUMNS    OF    THE    B    MATRIX. 
2 

ENTER    THE    ELEMENTS    OF    THE    B    MATRIX. 

2.0 

1,0 

0.0 

B(2,2)  = 
1.0 

0.0 

0.0 

THE    B     MATRIX 

2.00E+00       1.00E+00 
0.0  I.OOE-^00 

0.0  0.0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    NUMBER    OF    OUTPUTS. 
3 

ENTER    THE    ELEMENTS    OF    THE    C    iATEIX. 
0.0 

C  ( 1 ,  2)  = 

1.0 

C  ( 1 ,  3)  = 

0.0 

C(2,  1)  = 

1.0 

.    ^C(2,2)  = 
1.  0 

C(2,3)  = 
0.0 

o    C(3,1)  = 

-2.0 

C(3,2)  = 

1.0 

n     .C(3,3)   = 

0.0 
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THE    C    MATRIX 

0.0  1.00E+00       0.0 

1.00E+00       1.00E+00       0.0 

-2.00E+00       I.OOE^OO       0.0 

DO  YOU  WANT  TO  CHANGE  ANY  ELEMENT  OF  THE  MATRIX? 
n 

OBSERVABILITY  INDEX  =   2 

THE  SYSTEM  (A,  B)   IS  0  NC0NTR3LLABLE 

*********************  **********************************  *** 
DO  YOO  WANT  TO  RJN  0B3C0N  A3AIN? 

n 

THIS    CONCLUDES    THE    OBSERVABILITY    INDEX/CONTROLLABILITY 
PROGRAM     (OBSCON) 

ANALYSIS    IS    COMPLETE.     DO    YOJ    WANT    TO    RUN    LIKCON    AGAIN? 
n 

LINCON    IS    NOW    TERMINAPED. 

The   complete   results    prsssnted      in    Appendix    E    should 

be    self-explanatory    tD    the   user. 
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C.       OPTIMAL    CONTEOL/KALMAN    FILTER    PROGRAM    (RICATI) 

The  transient     solution,  sn-itrix   gains,      to      the    Riccati 

differential     equatioas   for  ths    state-regulator      controller 

and     the  continuous      Salman  filter     are   calculated      by      the 
RICATI   program. 

Given   a     state- rsgulator  problem      with    the      linear, time- 
in  variant  system 

i  (t)    =   Ax  (t)    ♦    Ba  (t)  (4.C-1) 

lit)     =    Cx(t)  (U.C-2) 


the   Riccati   equation   is   defined    as 

£(-)     =    -P(t)A-A^P(t)+P  (t)  BR-iB    ?(t)-2  (y.  C-3) 


with    P  (to )         as    thr      boundary    CDQdition.  If    u(t)         is    not 

constrained,      a    gain   aa-trix    can    be      found    such    that    the    cost 
function 

J=1/2rx"'  (t;  )P(t^)x(t^l   ]+1/2/[x'^(t)  2x{t)  +u"^(t)  Ru(z)  ]dt  (a.C-4) 

"to 

is  minimized  [  5].   Sich  a  gain  aanrix  is  defined  as 

G  Jt)   =  R-ib"^P  (t)  (U.  C-5) 

and 


'4U 


U(t)  =  -G^(t)X(t) 


(4.C-6) 


The  transient  solutiDQ  is  solvei  by  the  computer.  Note  that 
the  output  from  the  ::omputer  for  the  gain  matrix  does  not 
include  the  negative  sign  of  ths  feedback  loop. 

Given  a  continous  Kalman  filter  problea  with  the  linear, 
time-invariant  system 


X(t)  =  Ax  (t)  +  Bw  (t) 


{4.C-7) 


lit)     =  Cx(t)  *  v(t) 


(4.  C-8) 


where  w(t)  ,  the  random  process  forcing  input  and  v(t),  the 
measurement  noise,  hive  covariaice  matrices  of  R,  the  random 
input  covariance  matrix,  and  2r  the  measurement  noise 
covariance  natrix,  respectfully,  the  Riccati  equation  is 
defined  as 


I(t)  =  AP(t)+P(t)A  ■^B2B^-l.(t)  c"^R-iCP(t) 


(t*.  C-9) 


with 


l(to)  =  2([  x(t,)-x  ]:i(^o)  -1  f\ 


(U.C-10) 


as  the  initial  condition  boundary.   The  gain  matrix  found  is 
defined  as 


G^(t)  =  I-iCP(t) 


(4.C-11) 
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1.   Ter  minal  Sssiion  Examgls 

This  section  contains   a  session   for  the   specific 

example  presented  by  Melsa  [  1],  Commands  entered   by  the 

user  are  in  lower  case.  Given  ttis  second  order  linear  system 


.      *"-1.0  o.o'       ""l.O  o.o"' 
x(t)    =  x(t|  +  u(t) 

0.5  0.0  3.0   1.0 

L  J  I.  J 


^   1.0   o.o' 


0.0    2.0 

L  J 


determine  the  optimal  transient   response  con-crol  and  filter 
gains  for 


2  =  2  = 


R  =  R  = 


■"i.o   i.o' 

1.0    1.0 

L  J 


■"lo   o.o' 

0.0    2.0 


For  the  control  option  an  initial  time  of  0.0  and  a  final 
time  of  10.0  is  ussd.  For  th=  filrer  option  an  initial  time 
of  0.0  and  a  final  tiie  of  5.0  is  used.  Also,  for  t.he  filtsr 
option,    the    initial   oondition    mtrix    is   chosen    to    be 
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_''o,o 

o.d' 

£(%) 

"    0.  0 

L 

0.3 

J 

For  both  options  tan  equally  spaced  values  of  G  and  3  on 
the  time  interval  t  <  t  <  t  ar3  used,  i.e.,  NPOINT  is  set 
equal  to  10. 

lincon 

EXECUTION     BEGINS 

LINCON    CONSISTS    OF    THE    FOLLOWINS    SUBPROGRAMS: 

BASIC    MATRIX    MANIPaLATION    -    <BASMAT> 

RATIONAL   TIME    RESPONSE    -    <RrRESP> 

STATE    VARIABLE    FEEDBACK    -    <3rVAR> 

CONTROLLABILITY    AND    OBSERVABILITY    -    <OBSCON> 

LQENBERGER    OBSERVER    -    <LaEN> 

OPTIMAL    CONTROLAALMAN    FILTERS    -    <RICAri> 

DISCRETE   TIME    KALMAN    FILTER    -    <KALMAN> 

OPTIMAL    CONTROL    -     <OPTCON> 

PARTIAL    FRACTION    EXPANSION    -     <PRFEXP> 

ROOTS    OF    A    POLINDIIIAL    -    <RODrS> 
TO    OSE    ONE    OF    THE    SUBPROGRAMS    ENTER    THE    NAME    BETWEEN    THE 
SYMBOLS    <    >, 
r icati 

RICATI     DETERMINES    THE    TRANSIENT    SOLUTION  'fOR    THE    RICCATI 
EQUATION.     FIRST    ENTER    THE    PROBLEM    IDENTIFICATION 
(*NOT    TO    EXCEED    20     CHARACTERS*) 
thesis   ex  a  uple 


2 


NOW,  ENTER  THE  ORDER  OF  THE  SYSTEM  (UP  TO  8)  . 
ENTER  THE  ELEMENTS  OF  THE  PLANT  MATRTX--A. 


-1.0 

A  (1,2)  = 

0.0 

n  ,A(2,1)  = 

0.0        ■ 

A  (2,  2)  = 

-2.0 

THE    A     MATRIX    (PLANT    1ATRIXI 
-I.OOE+OO       0.0 
0-0  -2.00E+00 

DO    YOU    WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    NUMBER    OF    CONTROL    INPUTS. 
2 
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ENTER    THE    ELEMENTS    OF    THE    DrSTRIBOTION    MATRIX — B. 
1.0 

0.0 

«    ^B(2,1)  = 

0.0 

3(2,2)  = 
1.0 

THE    B     MATRIX    (DI3 TRI3UTIDN    MATRIX) 

1.00E+00       0.0 

0.0  1.00E+00 

DO    YOa     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    NUMBER    3F    0BSSRVA3LE    OUTPUTS. 
2 

ENTER    THE    ELEMENTS    OF    THE    MEASUREMENT    MATRIX — C. 
1.0^^^'^^  = 

0.0^^^'^^  = 

n    ^C(2,1)  = 

0.0 

.    ,C(2,2)  = 
2.0 

THE    C     MATRIX     (MEASUREMENT    MATRIX) 

1.00E+00       0.0 

0.0  2.00E+00 

DO    YOU     WANT    TO    CH\NGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

YOU    HAVE   TWO    OPTIONS    AVAILABLE: 

(1)  THE    CONIRDL    OPTION    FDR    SOLVING    STATE-REGULATOR 
PROBLEMS,    OR 

(2)  THE    FILTER     OPTION    FOR    SOLVING    A    CONTINUOUS    KA LMAN 
FILTER    PROBLEM. 

FOR    THE    CONTROL    DPTION,     ENTER    THE    LETTER    C. 
FOR    THE    FILTER    OPTION,     ENTER     THE    LETTER    F. 
c 

ENTER    THE    ELEMENTS    OF    THE    CONTROL    WEIGHTING    MATRIX-- R. 

1.0 

0.0 

0.0 

2.0 

^8 


THE    R     MATRIX    (CONTROL    WEISSTING    MATRIX) 

1.00E+00       0.0 

0.0  2. OOE+00 

DO    YOU     WANT    TO    CaiNGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    ELSMENIS    OF    THE    STATE    WEIGHTING    MATRIX — Q. 
1.0 
1.0 
1.0 

.     ^Q(2r2)  = 

1.0 

THE    Q     MATRIX    (STATE    WEIGHTING    MATRIX) 

1.  OOE+00       1.00E+30 
I.OOE+OO       1. OOE+00 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    INITIAL    TIME    FOR    THE    TRANSIENT    RESPONSE. 
0.0 

ENTER    THE    FINAL    TIME    FOR    THE    TRANSIENT    RESPONSE. 
10.0 

ENTER    THE    NUMBER    OF    POINTS    DF    THE    TRANSIENT    RESPONSE 
TO    BE    PRINTED.  (<100) 

10 

*****:)£*  ♦^^^^t*  ********* 

***  CONTROL  OPTIDN  *** 
********************** 

ENTER  THE  ELEMENTS  OF  THE  TERMINAL  BOUNDARY  VALUE 
MATRIX--?. 

0.0 

0.0 

?  (2,1)  = 

0.0 

n  n^<2,2)  = 

0.0 

THE    P     MATRIX    (TERMINAL    30UJJDARY    VALUE    MATRIX) 

0.0  0.0 

0.0  0.0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 
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TRANSIENr    SOLJTIDN 

TIME    =  1.000E+01 
GAINS 

0.0  0.0 

0.0  0.0 

TIME    =  9. OOOE^OD 
GAINS 

3.75E-01  2.81E-01 

1.40E-01  1.11E-01 

TIME    =  8. OOOE+00 
GAINS 

3.98E-01  2.85E-01 

1.42E-01  1.12E-D1 

TIME    =  7. OOOE+OD 
GAINS 

U.00E-O1  2,85E-01 

1.a2E-01  1.12E-01 

TIME    =  6. OOOE+OD 
GAINS 

4.00E-01  2.85E-01 

1.42E-01  1.12E-01 

TIME    =  5.000E+00 
GAINS 

4.00E-01  2.85S-01 

1.42S-01  1.12E-01 

TIME    =  U. OOOE+OD 
GAINS 

4.00E-01  2.85E-01 

1.42E-01  1.12E-31 

TIME    =  3.000E*00 
GAINS 

4,0OE-01  2.85E-01 

1.42S-01  1.12E-31 

TIME    =  2.  OOOE<-00 
GAINS 

4.00E-01  2.85E-01 

1.42E-01  1.12S-01 

TIME    =  I.OOGE^OO 
GAINS 

4.00E-01  2.35E-01 

1.42E-01  1.12E-31 

TIMS    =  2.861E-06 
GAINS 

4.00E-01  2.35E-01 

1.42E-01  1.12E-01 
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DO    YOU     WANT    THE    FILTER    OPIIDN? 

y 

WILL  THERE  BE  CHANGES  TO  IHE  A,  B,  OR  Z    MATRICES? 
n 

WILL  THERE  BE  CHANGES  TO  THE  R  OR  Q  MATRICES? 
n 

ENTER  THE  INITIAL  TIME  FOR  THE  TRANSIENT  RESPONSE. 
0.0 

ENTER  THE  FINAL  TIME  FOR  THE  TRANSIENT  RESPONSE. 
5.0 

ENTER  THE  NUMBER  OF  POINTS  DF  THE  TRANSIENT  RESPONSE  TO 
BE  PRINTED.  (<103| 
10 

***  FILTER  OPTIOfI  *** 

ENTER  THE  ELEMENTS  OF  THE  INITIAL  BOUNDARY  VALUE 
MATRIX--P. 

0.0 

0.0 

0.0 

0.0 

THE    P    MATRIX    (INITIAL    30JNDARY    VALUE    MATRIX) 

0.0  0.0 

0.0  0.0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

TRANSIENT    SOLUTION 

TIME    =  0.0 
GAINS 

0.0  0.0 

0.0  0.0 

TIME    =  5. OOOE-01 
GAINS 

2.39E-01  2.00E-01 

8.02S-01  6.85E-01 

TIME    =  1.000E+0D 
GAINS 

2.71E-01  2.13E-31 

8.51E-01  7.05E-01 

TIME    =  1. 500E+0D 
GAINS 

2.77Z-01  2.13E-01 

8.53E-01  7.06E-01 
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TIME    =  2.  OOOE<-00 
GAINS 

2.78E-01  2.13E-31 

8.53E-01  7.06E-01 

TIME    =  2.500E^-03 
GAINS 

2.79E-01  2. 13E-01 

8.53E-01  7.06E-01 

TIME    =  3.000E>0D 
GAINS 

2.79E-01  2.13E-01 

8.53E-01  7.06E-01 

TIME    =  3. 500E+00 
GAINS 

2.79E-01  2.13E-01 

8.53E-01  7.06E-01 

TIME    =  1. OOOE+03 
GAINS 

2.79E-01  2.13E-01 

8.53E-01  7.06E-01 

TIME    =  U.  500E+00 
GAINS 

2.79E-01  2.13E-01 

8.53E-01  7. 062-01 

TIME    =  5. OOOE+00 
GAINS 

2.79E-01  2.13E-01 

8.53E-01  7.06E-01 

**********************  **********************************  *** 

DO    YOa  WANT    THE    CONTROL    OPTION? 

n 

THIS  CONCLUDES  THE  RICCATI  EQUATION  PROGRAM  (RICATI) . 

ANALYSIS  IS  COMPLETE.  DO  YOJ  WANT  TO  RJN  LINCON  AGAIN? 
r. 

LINCON  IS  NOW  TERMINATED. 

The  computer   results  for  both  options   presented  in 

Appendix  F  indicates  that   a  stsidy   state  gain   matrix  has 

been  achieved. 
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D.       DISCRETE  TIME   KALMAN    FILTER  .  (KALM AN) 

The  discrete  Kaiman  filtsr  gain  matrix,  G(k)  ,  is 
calculated      by      this      program.  The      thsoretical      concepts 

involved  in  the  development  of  the  computer  codes  are 
described  by  Sage  [  5].  A  brief  development  of  the  discrete 
Kalman  filter  is  included  hera  as  an  aid  in  the  use  of 
KALIAN.  Additional  raference  materials  can  be  found  in  the 
biblicgraph  y. 

Kalman        filtering  is        a  method        of  obtaining 

minimum-variance        estimates  Df        signals  from        noisy 

measurements.  The  discrete  Kalman  filter  provides  state 
estimates   for    the   following    system 

i(k)    =   |x  (k-1) +Au(k-1)  *rw(k-1)  (f4.D-1) 

with   the   discrete  lin=ar   observations 

z(k)    =    Hx(k)  +  v  (k)  (4.D-2) 

where 

X  =    the  nx  1    stare  vector   at    ths    time    t  (k) 

$  =   the   nxn   ncnsingular   state   transition   matrix 

r   =    the   nxr   disturbance   transition    or    distribution    ma-rix 
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A  =   the  nxp   control    iistributioa    matrix 

w  =   the   rxl    iisturbaace   of   systsm    random   input   vector 

2  =   the   mx  1    measursmsn  t   vector 

H  =   the  mx 1    measur3m=nt   or   observation   vector 

V  =   the   mx 1    measursmant   nDise   vector 

u  =   the   px 1    control   or    test   sigaal    vector 

k   =   the   discrete-time    index    (Ic   =    0,1,...) 

The  optimal   filtered   estimate    of   x(k),    denoted 
x(k|lc),    IS   given  by   the   recursive    relations 

x(k|k-1)    =    |x(k-l|k-1)     ■»•  ru(k-1(  (4.D-3) 

and 

x(k|k)    =   x(k|k-1)    +    i(k)  [z  (k) -Hx  (k|  k-1)  ]  (4.  D-U) 

for  k  =  0,1,...,  where  x(0,0)   =  0.   The  Kaiman  gain  matrix, 
G(k),  is  an  nxm  macrix  which  is  specified  as 

G(k)=P  (k|  k-1)a''^rHP  (kU-1)H  +R(k)]-i  (U.D-5) 


P(kjk)  =  [  I-G(k)  H]P  (k|  k-1|  (4.  D-6) 

P(klk-I)  =  |p(k-l|k-i|  I  +2(i^r^-1>  (U.  D-7) 


where 
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I  =   th9   nxn   iientity   latrix 

P(0|0)    =   P(C),    the   initial   coniLtion   matrix 

x(k|lc-1)    =    the    singls-stage  preiiction   of   x(lc) 


A 


x(k|k)    =   the  filtered    estimats    of    x(k) 

Q  =    lE{w(k)w(k)    }l     ,    the   nxn   co/ariance   matrix   of   the 

"  ~        random   in pat 

R  =   the   mxn   covarianca    matrix   of    the    measurament    noise 


Efw(k)w(k)     },    the   nean-sqaare   magnitude   of    the   perturbation 
~  acceleration    matrix 


''•      In  g  ut    Reguire  J  ents 

This        prograa        computes  the        recurrence        Eqs. 

(a.D-5) , (U. D-5)  and  (U.D-7)  for  a  specified  number  of 
iterations    NP   and  prints   £{k)    a=    a    function    of   k. 

The   required   inputs   are 

1)  the  transition  matrix  (|) 

2)  the  distributiDn  matrix  (P) 

3)  3{w  (k)w(kl"^} 

4)  the  observation  matrix  (H) 

5)  the  number  of  points  t  o  be  performed  (NP) 


ana 


6)     the    initial    conditio!    matrix   [£(0(0)  ]. 


0  0 


2.      T9rm,nal  Session   Sxamqls 

This  sectio.i  contains  a  session  for  a  specific 
problem.  Commands  entered  by  the  user  are  in  lower  case. 
The   following   system   is  -co   be   tasted: 


x(k)    = 


1  .0 
0.0 


0.5 
1.0 


X  (k-1) 


""O.  125'' 
0.5 


w(k-1) 


z(k)     =   [  1  .0      0.0]    K(k)    f    v(lc) 


R    =    [5-0  ] 


E{w(k)  w(k)    }     =   U.  0 


P(0)    = 


1000.0 
0.0 


0.0 

1000.: 


The   number    of    time    points   to    be    romputed    is    chosen   -o    be    20. 


imcon 

EXECUTI 

LINCON 

BASI 

RATI 

STAT 

CONT 

LUEN 

OPTI 

DISC 

OPTI 

PABT 

ROOT 

TC    USE 

SYMBOL 

kalman 


ON     BE 
CONS 
C    MAT 
ON  A  L 
E    VAR 
ROLLA 
BERGE 
MAL    C 
RETE 
MAL    Z 
lAL    F 
S    OF 
ONE 
S    <    > 


GINS 

ISTS  OF  THE  FOLLOWING  SUBPROGRAMS: 

RIX  MANIPULATION  -  <EASMAT> 

riME  RESPONSE  -  <RrRESP> 

TABLE  FEEDBACK  -  <3r7AR> 

BILITY  AND  OBSERVABILITY  -  <OBSCON> 

R  OBSERVER  -  <LUEN> 

ONTROL/KALMAN  FILTERS  -  <RICAri> 

TIMS  i(ALMAN  FILTER  -  <KALMAN> 

ONTROL  -  <OPrCON> 

EACTIDN  EXPANSION  -  <?RFEXP> 

A  POLYNOMIAL  -  <RO0TS> 

OF  THE  3JBPR0GHAMS  ENTER  THE  NAME  BETWEEN 


THE 


KALMAN     DETERMINES    THE    DISCRETE    KALMAN    FILTER    GAIN    MATRIX 
—  G(K)  .     FIRST    ENTER    THE    PROBLEM    IDENTIFICATION 
(*NOT    TO    EXCEED    23    CHARACTERS*), 
thesis    exa  niple 

NOW,    ENTER.    THE    ORDER    OF    THE    SYSTEM     (UP    TO    8)  . 
2 
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ENTER  THE  ELEMENTS  OF  THE  TRANSITON  MAIEIX — PHI 
PHI(1,1)= 

PHI(1,2)= 

.5 

PHI(2,1)  = 
0.0 


1. 


n 


1 


PHI(2,2)= 

THE    PHI   MATRIX    (rRANSITI3N    MATRIX) 

1.00E+00  5.0DE-01 

0.0  1.00E+00 

DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
ENTER    THE    DIMSNSIDN    OF    THE    5AND0M    INPQT    VECTOR. 


ENTER    THE    ELEMENIS    OF    THE    DISTRIBUTION    MATRIX — GAMMA. 
GAMMA(1  ,1)  - 
.125 

GAMMA  (2,1)  = 
.5 

THE    GAMMA    MATRIX     (D  ISTRIBailON    MATRIX) 

1. 25E-0  1 
5.00E-0  1 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

ENTER    THE    SLEMENPS     OF    THE    llEAN-SQUARS    .MAGNITUDE    OF    THE 
PERTURBATION    ACCSLERAIION    MATRIX — W. 

THE    W     MATRIX    (MSAN-SDUARS    MAGNITUDE    OF    THE 
PERTURBATION    AC:ELERATI0N    MATRIX) 

4.00E+0  0 

DO  YOU  WANT  TO  CHANGE  ANY  ELEMENT  OF  THE  MATRIX? 

ENTER  THE  NUMBER  DF  OUTPUTS. 

ENTER  THE  ELEMENTS  OF  THE  OBSERVATION  MATRIX — H. 
H(1,1)  = 

H(1,2)  = 

THE    H     MATRIX    (OBSERVATION    HATRIX) 
1.00E+00  0.0 
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n 
1 

1. 

0. 


DO  YOO  WANT  TO  CHANGE  ANY  ELEMENT  OF  THE  MATRIX? 
n 

ENTER  THE  ELSMENIS  OF  THE  MEASUREMENT  NOISE  COVARIANCE 
MATRIX--R. 

R(1r1)  = 

THE    R     MATRIX    (MEASaREMENT    NDISE    COVARIANCE    MATRIX) 

5.00E+00 

DO  YOU  WANT  TO  CHANGE  ANY  ELEMENT  OF  THE  MATRIX? 
n 

ENTER  THE  NUMBER  DF  THE  PDISIS  TO  BE  PERFORMED. 

20 

ENTER  THE  ELEMENIS  OF  THE  INITIAL  CONDITION  MATRIX--?. 

?(1,  1)  = 

1000. 

0. 

A   P<2,1)  = 

0. 

P(2,2)  = 
1000. 

THE    P     MATRIX    (INITIAL    CONDITION    MATRIX) 

1.00E+03  0.0 

0.0  1.00E+03 

DO    YOU     WANT  To" CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

K    =         0 
GAINS 
9.95E-0  1  0,0 

K    =         1 

GAINS 
9.31E-01  1.92S+00 

K   =         2 
GAINS 
8. 29 E- 01  9. 93 E -01 

K    =         3 
GAINS 
7.03E-01  6.2'4B-01 

K    =  U 

GAINS 
6.13S-01  4.52E-01 
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K   =         5 
GAINS 
5.5aE-01 


3.72E-01 


K    =         6 
.   GAINS 
5.  18E-0  1 


3.35E-01 


K   =         7 
GAINS 
U.  99E-0  1 


3. 23E-01 


K    =         8 
GAINS 
4.  90E-0  1 


3.2DE-01 


K    =         9 

GAINS 
4.87E-0  1 


3.20E-01 


K    =       10 

GAINS 
U.86E-01 


3.  21E-01 


K    =       11 
GAINS 
4.  86  E- 0  1 


3.21E-01 


K   =       12 

GAINS 
a.86E-0  1 


3.212-01 


K    =       13 
GAINS 
U.86E-01 


3, 21B-01 


K    =       14 
GAINS 
4.36E-0  1 


3.21S-01 


K    =       15 

GAINS 
4.  86  E- 0  1 


3. 21E-01 


K    =       16 

GAINS 
4.  36E-0  1 


3.21S-01 


K    =       17 

GAINS 
4.36E-01 


3, 21S-01 


K    =       18 
GAINS 
4.86E-0  1 


3.21E-01 
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n 


K   =       19 
GAINS 
a.86E-01  3.21E-01 

K    =       20 
GAINS 
4-86S-01  3.21E-01 

THIS    CONCLUDES    THE    DISCRETE    JCALMAN    FILTER    PROGRAM 
(KALMAN). 

ANALYSIS   IS    COMPLETE.     DO    YOJ    WANT    TO    RUN    LINCON    AGAIN? 

LINCON     IS    NOW    TERMINATED. 

The   computar   results   irs    presentsi    in    Appendix   3. 
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E.       STATE    VARIABLE    FEEDBACK    PRDSRAM     (STVAR) 
Given   the   linear  time-invariant   system 

kit)     =  Ax(t)     +   bu(t>  (£4.E-1) 

u  (t)     =   K:r(t)    -   js   x(t)  ]  (U.  E-2) 

y  (t)     =  c'^x(t)  (^.S.3) 

the  following  can  be  performed  by  STVAR 

(1)  calculation  of.    the  plant  ^ranfer  function,  Y(s)/U(s) 

(2)  by  defining  a  fictii^iDus  c  vector  the  internal 
transfer  function  can  b=  calculated,  X^(s)/U(s);  for 
example,  if  X^  (s)/U(3)  is  desirsi  the  c  matrix  is 
selected  wita  C3  =  1  and  all  other  c  elements  equal 
to  zero;  or  if  X,  (s| /X3  (s)  is  desired,  calculate 
X,(s)/U(s)  and  X3(s)/U(3)  and  divide  the  two 

(3)  calculation  Df  the  clDsed-loop  transfer  function, 
Y(s)/R(s) 

(U)  calculation   Df  the   feedback  transfer   function, 

(5)  for  a  desired  closed-lDop  transfer  function,  the 
controller  gain  and  feedback  coefficients  in 
addition   to    H«a  (s)    can    be   calculated;     the 
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feedforward  gain  is  saLacted  so  that  a  zero  steady 
stats  error  rasults  froB  a  step  input;  the  designer 
who  wishes  other  conditions  must  rescale  the  gain 
and  feedback  coefficiants  appropriately;  for 
example,  if  it  is  desirad  to  hava  K  =  1.0  but  ir  is 
calculated  as  K  =  2.0  rfith  feedback  coefficients  of 
k  =  0.5,  k  =0.0  and  k  =  1.5,  the  procedure  "^-o 
modify  the  rasults  wouli  be 


2.0 

}^   = j-0.5   0.0   1.5] 

"1.0 


=  [  1.0   0.0   3.0] 

All  of  the  information  nacassary  for  the  user  to  solve 
state  variable  feedback  problams  is  prasentad  in  this 
section.  However,  tia  theoretical  concepts  involved  in  the 
development  of  the  computer  CDdas  are  fully  describad  by 
Melsa  [  7]. 

The  basic  input  contains  zha  problem  identification, 
matrices  A  and  b  and  the  ordar  Df  the  plant,  n.  These  four 
inputs  are  required  regardless  Df  what  open-  or  closed- loop 
calculations  are  to  ba  made. 

At  rhis  poinx  5T7AR  varifias   the  controllability  of  the 

system.  Three  controllability  CDndiuicns  are  possible 

(1)  complete  controllability 
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(2)  numerically  uncontrollable 
and 

(3)  unccntrollability 

Contollability  arises  when  the  controllability  matrix 

E  =  [  b  Ab  A2b  ...  4'^ -lb]  (4.  2-U) 

is  nonsingular,  i.s.  ,  ietE  *  D.  Even  if  the  matrix  is 
nonsingular  problems  may  arisa  if  it  is  difficult  to  invert. 
To  check  this  STVAR  mmltiplias  the  matrix  by  its  calculated 
inverse.  The  result  should  ba  the  identity  matrix.  The 
actual  matrix  product  is  comparad  with  tha  identity  latrix 
to  provide  a  measura  of  uncontrollability.  If  the  maximum 
value  of  deviation  is  not  negligible,  the  plant  is 
identified  as  numeri-illy  uncontrollable,  \  deviation  larger 
than  10-3  to  1 O-s  has  bean  found  to  indicate  difficulty  by 
Melsa  C  1]. 

2§§^  k^^£®-  ^-  "^'^-^  systam  is  identified  as  baing 
uncontrollable,  all  Dpen-  and  ~losed-loop  calculations  are 
still  performed! 

There  are  three  possible  closed-loop  op-cions  available, 
one  for  analysis  purposes  only  and  the  othar  two  for  dasign 
purposes.  After  choosing  the  analysis  option,  and  supplying 
STVAR  with  the   feedforward  gain  K  and   feedback  coefficient 


matrix   k,  the  program   calculates   the   closed-loop 

characteristic   pol/aomiai  ani   the   aamerator  of   the 
equivalent  feedback  transfer  fuaction. 

The  two  design  options  are  used  to  calculate  the 
controller  gain  and  the  feedba::k  coefficients  necessary  for 
a  desired  closed-loop  characteristic  polynomial.  The 
polynomial  may  be  entered  in  either  polynomial  form  or 
factored  form. 

1.   Terjinal  Session  Sxam2l|, 

This  section.  contains  a  third  order  system  for 
analysis  by  STVAE  as  presented  by  Melsa  [  1].  The  state 
variable  representation  of  the  plant  is  given  by 


-1.0  1.0  0.0         0.0 

X  (t)  =   0.0  0.0  1.0  x(t|  +  0.0  u(^) 

0.0  -3.0  0.0  "       1.0  ~ 

L.  J  L      J 


I  (t)  =   [1.0    1.0    0.0  ]  x(t| 

For  the  open-loop  case,  it  is  desired  to  find  the 
internal  transfer  far.ction  X  (s)  /U  (s)  and  the  plant  transfer 
function  Y(s)/U(s).  A  ficticious  matrix,  necessary  to  find 
the   internal  transfer    function,    is    then 


c    =   [0. 0         0.0         1.0] 
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In  addition,  find  tha  values  of  the  feedforward  gain  and  the 
feedback  coefficients  requirsi  to  givs  a  closed-loop 
transfer   function  of 


Y(s)      _  2(s+2) 

rIs)  s3+432*6s>a 


lincon 

EXECUTION  BEGINS... 

LINCON  CONSISTS  OF  THE  FOLLOWING  SUBPROGRAMS: 

BASIC  MATRIX  MANIPULAriON  -  <BASMAT> 

RATIONAL  TIME  RESPONSE  -  <RTRESP> 

STATE  VARIABLE  FEEDBACK  -  <3rVAR> 

CONTROLLABILITY  AND  OBSERVABILITY  -  <OBSCON> 

LUENBERGER  OBSERVER  -  <LUEN> 

OPTIMAL  CONTROL/KALMAN  FILTERS  -  <RICAII> 

DISCRETE  TIME  KALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPTCON> 

PARTIAL  FRACTION  EXPANSION  -  <PRFEXP> 

ROOTS  OF  A  POLYNDilAL  -  <RODTS> 
TO  USE  ONE  OF  THE  SJBPROGRAMS  ENTER  THE  NAME  BETWEEN  THE 
SYMBOLS  <  >. 
stvar 

STVAR  DETERMINES  INTERNAL  TRANSFER  FUNCTIONS, 
THE  PLANT  TRANSFER  FUNCTION.  THE  CLOSED-LOOP  TRANSFER 
FUNCTION,  AND  THE  EQUIVALENT  FEEDBACK  TRANSFER  FUNCTION. 
IN  ADDITION,  THE  CONTROLLER  GAIN  AND  THE  FEEDBACK 
COEFFICIENTS  NECESSARY  TO  ACHIEVE  A  SPECIFIED  CLOSED- 
LOOP  TRANSFER  FUNCTION  ARE  CALCULATED. 

FIRST  ENTER  THE  PROBLEM  IDENTIFICATION 
(*NOT  TO  EXCEED  23  CHARACTERS*)  . 
thesis  ex  a  irple 


3 


-1. 


NOW,    ENTER    THE    ORDER    DF    THE    SYSTEM     (UP    TO    8). 

ENTER    THE    ELEMENTS    OF    THE    PLANT    MATRIX--A 
A(1,1)  = 


1. 

A(1,2)  = 

0 

A(1,3)  = 

0 

A(2,1)  = 

0 

A(2,2)  = 

1. 

A(2,3)  = 

0 

A(3,1)  = 
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A(3,2)  = 

Q       A(3,3)  = 

THE    A     MAIRIX    (PLANT    SATRIXl 
-1.  OOE-t-00      1.00E+00      O.D 
0.0  0.3  1.00E  +  00 

0.0  -3.00E+00      0.3 

DO    YOU    WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

ENTER    THE    ELEMENTS    OF    THE    CONTROL    VECTDR — B. 
B(1)  = 

B  ( 2)  = 

3(3)  = 

THE    B     MATRIX    (CONTROL    MATRIX) 
0.0 

0.  0 

1.  OOE  +  00 

DO    YOa     WANT    TO    CHANGS    ANY    ELEMENT    OF    THE    MATRIX? 
n 

OPEN-LOOP    CALCOLATIOtJS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
3. GOE+OO      3.00E+00       1.30E+00       1.00E+00 

THE    ROOTS     ARE  REAL    PART  IMAG.     PART 

0.0  -1.73E+3D 

0.0  1.73E4-00 

-I.OOEfOO  0,0 

DO  YOD  HAVE  A  FICTICIOUS  OaiPUT  VECTOR  TO  ENTER? 


n 

0 
0 

1. 


n 


ENTER    THE    SLEMENIS    OF    THE    FICTICIOUS    OUTPUT    VECTOR--C. 
C(1)  = 

C(2)  = 

C(3)  = 

THE    C     MATRIX    (FICTICIOUS    OJTPUT    VECTOR) 
0.0 

0.  0 

1.  GOE+OO 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

NUMERATOR    COEFFICIENTS    -    IlT    ASCENDIN3    POWERS    OF    S 
0.0  1.00E+00      1.D0E+00 
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6. 


THE  ROOTS  ARE        REAL  PART  IMAG.  PART 

-I.OOEfOO   0.0 
0.0        0.0 
DO  you  HAVE  ANOTHER  FICTICIDQS  MATRIX  TO  ENTER? 

ENTER  THE  ELEMENIS  OF  THE  TRUE  OUTPUT  7ECrOR--C. 
C(1)  = 

C(2)  = 

C(3)  = 

THE    C     MATRIX    (OUTPUT    VSCrOS) 

1.  OOE+00 
1  .  OOE  +  00 
0.  0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

NUMERATOR    COEFFICIENIS    -    1)1    ASCENDING    POWERS    OF    S 

2.  COS  +  00      1.00E  +  00 

THE    ROOTS     ARE  REAL    PART    IMAG.    PART 

-2.00E«-00       0.0 
THIS    PROGRAM    IS    CAPABLE   OF    PERFORMING    THREE    TYPES 
OF    CLOSED-LOOP    CALCULATIONS.     ONE    TYPE    FOR    THE    ANALYSIS 
MODE.    THE    OTHER    TrfO    FDR    DESIGN. 

ENTER    ONE    OF   THE    FOLLOWING    DIODES: 

1)  A    —    FOR    THE    ANALYSIS    13DE 

2)  P    --    FOR    THE    DESIGN    MDDE    WITH    THE    UNFACTORSD 

CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 

3)  F    --     FOR    THE    DESIGN    MDDE    WITH    THE    FACTORED 

CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 

CLOSED-LOOP    CALCJLATIONS 

KEY    =     P         ***** 
ENTER    THE    DESIRED    CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 
COEFFICIENTS    IN    ASCENDING    POWERS    OF    S. 

YOUR    HIGHEST    ORDER     C0EFFI3ISJIT    MUST    BE    A     VALUE    OF    ONE. 
POLY  (1)  = 

POLY  (2)  = 

POLY  (3)  = 

POLY  (U)  = 

THE    NUMERATOR    OF     H- EQUIVALENT    - 
IN    ASCENDING    POWERS    OF    S 

5.00E-01       1.50E  +  00       1.50E  +  00 

THE  ROOTS  ARE        REAL  PART  IMAG.  PART 

-5.00E-01  -2.89E-01 
-5.00E-01   2.89E-01 
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THE    FEEDBACK    COEFFICIENTS 

5.  OOE-01       0.  D  1.50E  +  00 

THE    GAIN    =  2.000000E  +  00 

THE    CLOSED-LOOP    C HAEACTERI3 TIC    POLYNOMIAL    - 
IN    ASCENDING    POWERS    DF    S 

U.OOE+00      6.00E+00      4.D3E+00       1.00E+00 

THE    ROOTS     ARE  REAL    PURT  IMAG.    PART 

-2.00Ei-0a  0.0 

-1.00E+00  -1.00E+00 
-I.OOEfOO       1.00E+00 

MAXIMUM  NORMALIZED  ERROR  =   0.0 

DO  YOU  WANT  TO  RJN  ANOTHER  JIODE  IN  STVAR? 
n 

THIS  CONCLUDES  T3S  STATE  VARIABLE  FEEDBACK  PROGRAM 
(STVAR)  . 

ANALYSIS  IS  COMPLETE.  DO  YOJ  WANT  TO  RUN  LINCON  AGAIN? 

n 

LINCON     IS    NOW    lERaiNAIED. 

The   computsr      r^rsalts    f^r    this    probiem      is   pr9s=ntsd 

in   Appendix      H.      The      open-loop  portion      indicates    that      the 

system   is      controllable,      since  there   is      no    indicazion      of 

uncontrollability,        with      the  desired      internal      transfer 

function    of 


X3     (S)  S2fs 

U(S)  33-fs2+3s  +  3 

and   a   plant   transf=r   function   oE 


Y  (  s)        _  s  +  2 

U(s)  s3«-s2  +  3s  +  3 

The   closed-l3Dp   portion,    asing   the    polynomial   dssign 
mode,         shows        that      the      feedforward      qaia        and      feedback 
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coefficient  matrix  rsquired  to  yield  the  iasired  closed- loop 
transfer  function,  Y(3)/R(s),  ace 

K  -  2.0 

and 


k  = 


•"0.5^ 
0.0 
1.5 

L  J 
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F.   LUENBERGER  OBSERVER  PROGRAM  (LUEN) 

When  a  particular  3los5d-loop  transfer  function  is 
desired  and  some  of  the  states  are  inaccessible,  LUEN  can  be 
used  to  design  a  Lueaberger  Dbserver.  For  example,  if  q 
measurements  are  state  variables,  an  observer  of  reduced 
dimensions  can  be  designed  to  estimate  only  those  states 
which  are  not  measured.  The  state  estimates  generated  by  an 
observer  can  be  used  as  input  information  to  a 
controller  [8].  Tie  block  diagram  presented  in  Fig.  4-1 
represents  the  general  form  of  the  system  when  a  compensator 
is  placed  in  the  feedback  path. 


r(t). 


controller 


"A  A 


u(t)^Dlpnt: 


x(t). 


measurement 


y(t) 


observer 


S'(t>> 


z(t) 


Fig.  4.1.   Laenberger  Observer  Block  Diagram 
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The  plant  is  characterized  3y  the  state  and  measurement 
equations 

i(t)     =   Ax  (t)     +    Bu(tl  (U.F-1) 

Z(t)     =  CX  (t)  (U.  F-2) 

Z«  (t)      =   C    X(t)  (U.  F-3) 

An  observer  can  b9  designed  that  generates  an  estimate  y. 
which  converges  to  cie  state  x  as  time  becomes  large  [  9]. 
A  linear  controller  is  designs!  as 

u(t)  =  K[r(t)  -  ]c^x(t)  ]  (a,  F-U) 

in   which      all    states      can    be      measured.      Replacing      the    true 
state    with    the    estimate   yields 

u(t)     =  K[r{t)     -    k'^Kt)  ]  (4.F-5) 

where 

Is'^Kt)    =    h'^Z(t|     +    g^2(t»  (4.F-6) 

As  time  increases  k  2(t)  will  approach  k  x(t).  Sinc=  the 
reduced-order  observar  estimates  only  the  inaccssible 
states,  the  control  law  contains  measured  states  where 
available  and  observer  estimates  for  the  other  states. 
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For   ease  in   using    LUEU,    ths    following   are   defined; 


x(t)  =     n-elsmsnt   column    state   vector 


u(t)  =     plant   input 


z(t)  =      q-vector    of   systen    measurements 


z'  (t)  =     output   variable   to    be   controlled 


A 


=  plant  natrix  (n  x  n) 


=  distribution  matrix  (q  x  m) 


[assumptions:  (1)  3  ^  n  and  (2)  C  has  rank  q] 


=  output  aatrix 


r (t)     =  forcing  function 


K 


=      feedfori/ard   or   cc^troller   gain 


and 


=      feedba-k    coefficient   matrix(n    x    m) 


=     observer    feedback    coefficient    matrix 


=     output   feedoacic    cDefficien*    aatrix 


2(t)  =  esrimatei    szare   vector   of   x(t). 
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From   theory,   the  observer   is   dascribed   by 

lit)    =    izit)     +   3,z(t)    *    G^a(t)  (4.F-7} 

where 

F   =   observer   eigenvalus    matrix 
and 

G,    and   Gj.  =    observer   giin   matrices. 

Z»(s)/R(s)     can    be    solved    by    the    following    procedure: 

(1)  select  Z»(3)/S(s)  and  sDlve  for  K  and  !c  by  using  the 
STVAR    prograa 

(2)  use  the  0B3C0N  program  to  calculate  the 
observability  index;  the  observer  is  designed  to 
have  a  dimension  greater  than  or  equal  to  the 
observability    index    minas    one. 

(3)  select  the  F  eigenvaluBs;  these  should  not  = gual 
those    of   A,    previously    calculated   by    STVAR. 

(U)    use    LQEN   to    calculate    G,  ,    G^ ,    h   and   g. 
''•      XiEHiiliii  Session    Hxamgli 

The   example    prese?.-ed    hire    is    taken    from    Desjardins, 
PP.1U7   [    2],        Commands      enterei    by      the    user      are    in      lower 
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case.  However,  dae  to  the  spsrial  naturs  of  the  exaiple, 
comments  have  besn  added  to  the  terminal  session  for 
clarity.   Given  the  fourth  order  plant 


D.  0   1.0   0.0  0.0           0.0 

0.  0   3.0   1. 0  0.0           0.0 

x(t)    =  x(t)  +        u(t) 

3.0   3.0   0.0  1.0  -         0.0 

3. 0  -15.  -23.  -9.0            1.0 

L  J               L     J 


with 

z»(t)      =      [10.       20.       0.0      0.0]   x(t) 
Because  x,    and    x^   ars    the   only    neasureable   states 


1 .0      0.0      3.3      0.0 
Z  (t)       =  x(t) 

^  3  .0       1.0      3.0       0.0      - 

L  J 


The   closed-loop   transfer      funztion    to    be   achieved      is   chosen 
to    be 

— 51i!L-    =    -_ —2 

E(s)         s*+533+17s2+2S3+20 


lincon 

EXECU'^ION     BEGINS 

LINCON    CONSISTS    OF'tHE    FOLLOWING    SUBPROGRAMS: 
BASIC    MATRIX    MANIPaLAIION    -    <BASMAT> 
RATIONAL   TIME    RESPONSE    -    <RrRESP> 
STATE    VARIABLE    FSSDBAZK    -    <3rVAR> 
CONTROLLABILITY    Mi  D    OBSERVABILITY    -    <OBSCON> 
LUENBERGER    OBSERVER    -    <LaEN> 
OPTIMAL    CONTEOL/KALMAN    FILTERS    -    <RICAri> 
DISCRETE   TIME    KALMAN    FILTER    -    <KALMAN> 
OPTIMAL    CONTROL    -     <OPrCON> 
PARTIAL    FRACTION    EXPANSION    -    <PRFEXP> 

7U 


ROOTS    0 
TO    USE    ONE 
SYMBOLS    < 
s-cvar 

STVAR  D 
THE  PLA 
FUNCTIO 
IN  ADDI 
COEFFIC 
LOOP    TR 


F   A    POLYNOMIAL    -    <RODrS> 

OF    THE    SiJBPROGRAMS    ENTER    THE    NAME    BETWEEN    THE 
>. 


ETERMINES    INTERNAL    TRANSFER    FaNCTIONS, 
NT    TRANSFER    FUNCTION,     THE    CLOSED-LOOP    TRANSFER 
N,    AND    THE    EQUIVALENI    FEEDBACK    TRANSFER    FUNCTION. 
TION,    THE    CONTROLLER    GAIN    AND    THE    FEEDBACK 
lENTS    NECESSARY    TO    A:HIEVE    A    SPECIFIED    CLOSED- 
ANSFER    FUNCTION    ARE    ZALCULATED. 


NTER    THE    PROBLEM    IDENTIFICATION 
0   EXCEED    23     CHARACTERS*). 
MPLE 


FIRST    E 

(*NOT    T 

THESIS    EXA 

NOW,    ENTER    THE    ORDER    OF    THE    SYSTEM     (UP    TO    8) 


0 
1. 

0 
0 
0 
0 

1. 

0 
0 
0 
0 

1. 

0 


ENTER    THE    ELEMENTS    OF    THE    PLANT    MATRIX--A 
A(1,1) 

A(1,2 

A  (1,3 

A(1,4 

A  (2,1 

A  (2,2 

A(2,3 

A(2,a 

A(3,1 

A  (3,  2 

A(3,3 

A(3,a 

A(a,i 


A  (4,  2 
-15. 

-2  J. 


-9. 


A  (4,4 
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n 

0 
0 
0 


THE    A     MATRIX    (PLANT    SATRIXI 

0.0  1.30E+00  O.D                   0.0 

0.0  0.0  1.0DE  +  00      0.0 

0.0  0.3  O.D                   1.00E  +  00 

0.0  -1.50E■^01  -2.30E4-01    -9.03E  +  00 

DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

ENTER    THE    ELEMENIS    OF    THE    CONTROL    VECTOR — B. 
B(1)  = 

B(2)  = 

B(3)  = 

B(4)  = 

THE    B     MATRIX    (CONTROL    MATRIX) 

0.  0 
0.  0 

0.  0 

1.  OOE  +  00 

DO  YOU  WANT  TO  CHANGE  ANY  ELEMENT  OF  THE  MATRIX? 
n 

*5jt*  ******  ************    *********4C    *************************** 

OPEN-LOOP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN     ASCENDING    POWERS    OF    S 

0.0  1.50E+01       2.30E+01       9.00E+00       I.OOE+OO 

THE    ROOTS     ARE  REAL    PART  IMAG.    PART 

-S.OOEfOO  0.0 

-5.00E+aO  0.0 

-1.00E«-03  0.0 

0.0  0.0 

DO    YOU    HAVE    A    FICTICIOUS    OUTPUT    VECTOR    TO    ENTER? 
n 

ENTER    THE    ELEMENTS     OF     THE    TRUE    OUTPUT    VECTOR--C. 

C(1)  = 

20. 

C  (2)  = 

10. 

C(3)  = 


0 


c(a)  = 

THE    C     MATRIX    (OUTPUT    VECTOR) 
2.  OOE  +  01 
1.  COE  +  01 
0.  0 
0.  0 
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20. 

28. 

17. 

6. 

1. 


DO    yon     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

NUMERATOR    COEFFICIENPS    -    lU    ASCENDIN3    POWERS    OF    S 

2.  OOE  +  01       1.00E+01 

THE    ROOTS     ARE  REAL    PART    IMAG.    PART 

-2.00EfOO       0.0 

THIS    PROGRAM   IS    CAPABLE    OF    PERFORMING    THREE    TYPES 

OF    CLOSED-LOOP    CALCULATIONS.     ONE    TYPE    FOR    THE    ANALYSIS 

MODE.    THE    OTHER    IHO    FDR    DESIGN. 

ENTER    ONE    OF    THE    FOLLOWING    1DDES: 

1)  A    —    FOR    THE    ANALYSIS    .1DDE 

2)  P    —    FOR    THE    DESIGN    MDDE    WITH    THE    UNFACTORED 

CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 

3)  F    --    FOR    THE    DESIGN    MDDE    WITH    THE    FACTORED 

CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 

CLOSED-LOOP    CALZJLATIONS 

KEY    =     P         ***** 
ENTER    THE    DESIRED    CLOSED-LOOP    CHARACTERISTIC    POLYNOMIAL 
COEFFICIENTS    IN    ASCENDING    POWERS    OF    S. 

YOUR    HIGHEST    ORDER    COEFFICIENT    MUST    3E    A    VALUE    OF    ONE. 
P0LY(1)  = 

POLY  (2)  = 

POLY  (3)  = 

POLY  (4)  = 

POLY  (5)  = 

THE    NUMERATOR    OF     H-E)UIVALENr    - 
IN    ASCENDING    PO;JERS    DF    S 

2. OOE+01       1.30E+01    -5.30E+00    -3.03E+00 

THE    ROOTS     ARE  REAL    PART    IMAG.     PART 

-1.0'4Ef00       0.0 
3.21E*-00       0.0 

THE    FEEDBACK   COEFFICIENTS 

2. OOE+01       1.30E+01    -6,0OE+O0    -3.00E+00 

THE    GAIN    =  1.000000E  +  00 

THE    CLOSED-LOO?    CHARACTERISTIC    POLYNOMIAL    - 
IN    ASCENDING    POWERS    D?    S 

2.00E  +  01       2.30E+01       1.73E  +  01       6.00E  +  00       1.0GE+00 
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THE    ROOTS     ARE  REAL    PART    IMAG.    PART 

-I.OOSfDO    -2.00E+DD 
-1.00E+00       2.00E+00 
-2-00Ef30       0.0 
-2.00E+00      0.0 

MAXIMUM  NORMALIZED  ERROR  =   0.0 

DO  YOO  WANT  TO  RQN  ANOTHER  1DDE  IN  STVAR? 
n 

THIS  CONCLUDES  THE  STATE  VARIABLE  FEEDBACK  PROGRAM 
(STVAR)  . 

COMMENT:  rssults  indicate  that  the  systam  is 
conTiroIlabIa,  thit  th=  eigenvalues  of  A  are  -3.0, 
-5.0,  -1.0  and  0.0,  that  the  valaes  ofk  are  20.0, 
13.0,  -6.0  a.id  -3.0  and  that  K  is  equal  to  unity; 
the  observability  index  is  next  needed  to  design  the 
observer 

ANALYSIS  IS  COMPLETE.  DO  Y03  WANT  TO  RUN  LINCON  AGAIN? 

y 

LINCON    CONSISTS    OF    THE    F3LLDWI^3    SUBPROGRAMS: 

BASIC    MATRIX    MANIPULATION    -    <BASMAT> 

RATIONAL  TIME    RESPONSE    -    <RrRESP> 

STATE    VARIABLE    FEEDBACK    -    <5rVAR> 

CONTROLLABILITY    AJJ  D    OBSERVABILITY    -    <OBSCON> 

LUSNBERGER    OBSERVER    -    <LUEN> 

OPTIMAL    CONTROL/KALMAN    FILTERS    -    <RICAri> 

DISCRETE   TIME    XALMAN    FILTER    -    <KALMAN> 

OPTIMAL    CONTROL    -    <OPrCON> 

PARTIAL    FRACTION    EXPANSION    -    <PRFEXP> 

ROOTS    OF    A    POLYNO^IIAL    -    <RODrS> 
TO    USE    ONE    OF    THE    SUBPROGRAMS    ENTER    THE    NAME    BETWEEN    THE 
SYMBOLS    <     >. 
obscon 

OBSCON     DETERMINES     THE    OBSERVABILITY    INDEX    AND 
CONTROLLABILITY    DP     A    SYSTEM. 

FIRST    ENTER    THE    PROBLEM    IDE!J  TIFIC  ATION 
(*NOT    TO   EXCEED    23    CHA RACISRS*) . 

thesis   exa  irple 

NOW,    ENTER    THE    ORDER    OF    THE    SYSTEM    (UP    TO    8)  . 

ENTER    THE    ELEMENTS    OF    THE    PLANT    MATRIX--A. 
A(1,1)  = 


0 
1, 

0 
0 

0 


A(1,2)  = 
A(1,3)  = 
A(1,4)  = 
A(2,1)  = 


A  (2,  2)  = 
A  (2,  3)  =: 
A(2,4)  = 
A(3,1)  = 
A(3,2)  = 
A(3,3)  = 
A(3,a)  = 
A(U,1)  = 


.23A(4,3). 


-9. 


0.0 
0.0 
0.0 
0.0 


A(4,U)  = 

THE    A     MATRIX    (PLANT    lATHIX} 

1.00E+03  3.0  D.O 

0.0  1.00E  +  00  D.O 

0.0  0.0  1.00E+00 

-1.50E+01  -2.30E  +  01  -9.00E+00 

DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
ENTER    THE    NUMBER    DF    COLUMSS    OF    THE    3    MATRIX. 


ENTER    THE    ELEMENrS    OF    THE    B    MATRIX. 
B(1,1)  = 

E(2,1)  = 

B(3,1)^ 

B(4,1)  = 

THE    B     MATRIX 

0.0 
0.0 
0.0 
1. OOE+00 

DO    YOO     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
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ENTER  THE  NUMBER  OF  OUTPaTS. 


ENTER  THE  ELEMENPS  OF  THE  C  MATRIX. 
C(1,1)  = 


C(1,2)  = 
C(1,3)  = 
C(1,4)  = 
C(2,1)  = 
C(2,2)  = 
C(2,3)  = 
C(2,U)  = 


THE    C     MATRIX 
1.00E<-00       0.0  D.O  3.0 

0.0  1.00E+00      0.0  D.O 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

OBSERVABILITY    INDEX    =       3 

THE    SYSTEM     (A-B)     IS    CONTROLLABLE 

****DC*****5WC*********    *******************************  ****** 

DO    YOU     WANT    TO    RJN    0B5C0N    A5AIN? 

n 

THIS  CONCLUDES  THE  OBSERVABILITY  INDEX  AND 
CONTROLUBILITY  PROGRAM  (033C3N) 

COMMENT;  rssiilis  indicits  an  obssrvability  ini  =  x  of 
1;  ^His  p=rmi-3  the  dssign  of  a  second  order 
observer;  eigenvalues  of  -3.5  and  -U.O  are  chosen 
(no-  equal  to  -hose  of  the  plaat)  as  observer 
eigenvaj-ues 

ANALYSIS  IS  COMPLETE.  DO  YOJ  WANT  TO  RUN  LINCON  AGAIN? 

y 

LINCON  CONSISTS  OF  THE  FOLLOWING  SUBPROGRAMS: 

BASIC  MATRIX  MANIPULAIION  -  <BASMAT> 

RATIONAL  TIME  RESPONSE  -  <RrRESP> 

STATE  VARIABLE  FEEDBACK  -  <3rVAR> 

CONTROLLABILITY  A^D  OBSERVABILITY  -  <OBSCON> 

LUEN3ERGER  OBSERVER  -  <LUEN> 

OPTIMAL  CONTROL/KALMAN  FILTSRS  -  <RICAri> 

DISCRETE  TIME  SALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPrCON> 

PARTIAL  FRACTION  EXPANSION  -  <?RFEXP> 

ROOTS  OF  A  POLYNOMIAL  -  <R3DrS> 
TO  USE  ONE  OF  THE  SJBPR0GRAM3  ENTER  THE  NAME  BETWEEN  THE 
SYMBOLS  <  >. 
luen 
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LUEN    IS    USED   TD    DESIGN    LUENBERGER    OBSERVERS    TO 

ACHIEVE    A    GIVEN    :L0SED-L3DP    TRANSFER    FUNCTION    WHEN    SOME 

STATE    VARIABLES    ARE    INACCESSIBLE. 

FIRST    ENTER    THE    PROBLEM    IDENTIFICATION 
(NOT    TO    EXCEED    23    CHARACTERS), 
thesis   exaniple 


U 
2 

2 

0 

1. 

0 

0 
0 

0 

1. 

0 
0 
0 
0 

1. 

0 


ENTER  THE  ORDER  DP  THE  SYSTEM  (UP  TO  8|  . 

ENTER  THE  NUMBER  DF  MEASUREMENTS  (UP  ID  3). 

ENTER  THE  ORDER  DP  THE  OBSERVER  (DP  TO  8). 

ENTER  THE  ELEMENTS  OF  THE  PLANT  MATRIX--A. 
A(1,1)  = 

A(1,2)=^ 

A(1,3)  = 

A(i,a)  = 

A(2,1)  = 

A(2,2)  = 
A(2r3)  = 
A(2,4)  = 
A(3,1)  = 
A(3,2)  = 
A  (3,3)  = 
A(3,a)  = 
A(4,1)  = 


A(4,2)  = 
-15. 

A  (4,3)  = 

-23. 

.9  ^('^'^)  = 
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THE    A     MAIRIX  (PLANT    lATRIXl 

0.0  1.00E  +  00       0.}  0.0 

0.0  0.0                    1.00E+00  0.0 

0.0  0.0                   0.3  1.00E  +  00 

0.0  -1.50E-^01    -2.30E  +  01  -9.00E+00 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

ENTER    THE    ELEMENTS    OF    THE    DISTRIBUTION    MATRIX — B. 
B(1)  = 

B(2)  = 

3(3)  = 

B(4)  = 

THE    B     MATRIX    (DISTRIBUTION    MATRIX) 
0.0 
0.  0 
0.  0 
1. OOE+00 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

ENTER    THE    ELEMENIS    OF    THE    OJIPUT    MATRIX--C. 
C(1,1)  = 


1. 

0 

C(1,2)  = 

0 

C(1r3)  = 

0 

C(1,4)  = 

0 

C(2,1)  = 

1. 

C(2,2)  = 

0 

C(2,3)  = 

0 

C(2,U)  = 

THE    C     MATRIX    (OJTPUT    MATRIX) 

1.  COE  +  00      0.0  0.0  0.0 

0.0  1.00E+00       0.3  0.0 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 

n 

ENTER    THE    DESIRED     FEEDBACK    COEFFICIENTS. 

FDBK    COZFF  (1)  = 
20. 
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FDBK  COEPF  (2)  = 
13. 

FDBK  COEFF  (3)  = 
-6- 

FDBK  COEFF  (U)  = 
-3. 

THE  DESIRED  FEEDBACK  COEFFICIENTS 

2.  0QE  +  Q1 
1.30E-»-0l 

-6.  OOE  +  00 
-3. OOE+00 
DO    YOa     WANT    TO    CH^NGE    ANY    ELEMENT    OF    THE    MATRIX? 
n 

THE    OBSERVER    EIGENVAiaES    (F    MATRIX)     CAN    BE    SUPPLIED 
EITHER    IN    THE    FORM    OF    A    CHARACTERISTIC    POLYNOMIAL    OR    IN 
THE    ROOTS    OF    THAI    POLYNOMIAL. 

ENTER    EITHER    A    P    FOP    POLYNOMIAL    COEFFICIENT    FORM 
OR    AN    F    FOR      FACIORED    ROOT    FORM. 

J. 

ENTER  THE  REAL  PART  OF  THE  ROOT. 
-3.5 

ENTER  THE  MAGNITUDE  OF  THE  IMAGINARY  RDDT. 
0 

ENTER  THE  REAL  PART  OF  THE  ROOT. 

ENTER  THE  MAGNITUDE  OF  THE  IMAGINARY  RDDT. 
0 

OBSERVER  EIGENVALUES  REAL  PART  IMAG.  PART 

-3.50E+00   0.0 
-a. OOE+00   0.0 

THE    OBSERVER    CHAR ACTERISIIZ    POLYNOMIAL 
COEFFICIENTS    IN    ASCENDING    POWERS    OF    S 
1.40E+01       7.50E  +  00       1.D3E  +  00 

**********  ***********  ************************************* 

THE    F     MATRIX    (OBSERVER    EIGENVALUE    MATRIX) 
-7.50E  +  00       1. OOE+00 
-1.40E  +  01       0.0 

THE    G1    MATRIX     (OBSERVER    SAIN    MATRIX) 
8.55E  +  01       2.92E+01 
0.0  O.D 

THE    G2    MATRIX     (OBSERVER    GAIN    MATRIX) 
-3. OOE+00 
-1. 50E+00 

OUTPUT    FSSDBA:K    COEFFICIENTS 
2.  COE  +  01      3.  5  OE  +  00 

COMPENSATOR    FEEDBACK    COEFFICIENTS 
1.  COE  +  00      0.3 

THIS    CONCLUDES    THE     LUEN3ERGSR    OBSERVER    DESIGN    PROGRAM. 
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DO   YOa     WANT    TO    RUN    THE    PRDGRAM    AGAIN? 
n 

ANALYSIS   IS    COMPLETE.    DO    YOJ    WANT    TO    RJN    LINCON    AGAIN? 
n 

LINCON     IS    NOW    TERJlINArED. 

The    results    dE    ST7AR,       DBSCON      and    LUSN    are    shown   in 
Appendix   I.    From  these    the    the   observer    is   given   as 

""-7.5    1 .  o'""y,  ( t)  "■         ''SS.S    29.25'""x,   (t)^  ""-3.0^ 

YD    =  ^  ^  +  u(t) 

-14.0    0.0      y^(t)  0.3      0.0        X,  (t)  -1.5 


and 


''   x     (t)'  '■y    i^)' 

u(t)    =    1.0{r(t)    -    [20.0   3.5]        '  -   [1.0    0.0]    ^  } 


<i  (t)  y  .  (t) 
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G.       OPTIMAL   CONTROL    PROGRAM     (DPTCON) 

Given   the    linear,    tims-invariant   systsa   represented    as 

X(t)     =    Ax(t)     *■    Bu  (t)  (4.  G-1) 

OPTCON  will  minimize  the  cost  function 

J(N)=l/2x  (N)Qx  (N) +1/2  J"[x  (k)  25  C^)  *Ru^  (k^)  ]  (4.  G-2) 

where 

X  =  state  vector 

Q  =  measurement  Qoiss  covariance  matrix  (n  x  n) 
N  =  number  of  tiae  intervals  over  which  the  sum  is  made 
R  =  random  input  (a  scalar! 
A  =  plant  matrix  (n  x  n) 
B  =  distribution  matrix  (n  x  1) 
and 

u  (t)  =  control  (a  scalar). 
The  output  of  tli=  program  is  the  feedback  gain  ma-rix 
which,  when  multipliel  by  the  state  vector,  yields  a  scalar 
control.  The  following  recursive  equations  were  derived 
using  dynamic  programing,  start Lng  at  the  terminal  time  and 
working  backwards. 


=  ^  (k)P(k-1)V^(k|  ♦  Q  + 


P(k)  =  Z    (k)P(k-1)^(k|  ♦  2  +  RA(k)A  (k)  ,  P(0)  =  0     (U.  G-3) 
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A^  (k)    =  -[4P(k:-1)i]/:4  P(lf')4  *-    R3#  A  (0)  =  0 


(4.G-4) 
(4.  G-U) 


For  simplicity  ia  programiiag, 
defined: 


the  fDllowing  terms  are 


terminal  =    1/2x    (:J)Qx(N) 
trajectory    =   1/2  )    x(t)    2r('^) 


«f-i 


k-.o 


fuel   =    1/2  y Ru2(fc) 


1-      Tar  gjnal  Ssssion   SxamBls 

Given    xhe   system   and   parameters   described   below    find 
the    discrete  steady    state   gains    for    a    sampis    of    0,1. 


1.0         0.0  1.0 

L  J  I.  J 


Q  = 


""lo       1.0"' 

1.0         1.0 

L  J 


R    =    1.0 


In  addition,   run  the  program  for  a  time  interval  of 


ao. 


lincon 

EXECUTION  BEGINS., 
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LINCON  CONSISTS  OF  THE  FOLLOWINS  SaBPROGRAMS: 

BASIC  MATRIX  MANIPULAriON  -  <BASMAT> 

RATIONAL  TIME  RESPONSE  -  <arRESP> 

STATE  VARIABLE  FEEDBACK  -  <SrVAR> 

CONTROLLABILITY  \UD    OBSERVABILITY  -  <OBSCON> 

LUENBERGER  OBSERVER  -  <LUEN> 

OPTIMAL  CONTROL/KALMAN  FILT3RS  -  <RICAri> 

DISCRETE  TIME  KALMAN  FILTER  -  <KALMAN> 

OPTIMAL  CONTROL  -  <OPrCON> 

PARTIAL  FRACTION  EXPANSION  -  <PRFEXP> 

ROOTS  OF  A  P0LYND1IAL  -  <RODTS> 
TO  USE  ONE  OF  THE  SJBPROGRAMS  ENTER  THE  NAME  BETWEEN  THE 
SYMBOLS  <  >. 
optcon 

OPTCON  MINIMIZES  THE  THE  FOLLOWING  COST  FUNCTION: 

J  (N)  =MIN  (SUM  (X(  N)  T*Q*X(Nl  +UT  (N-1)  *R*0  (N-1)  )  ) 

THE  OUTPUT  OF  THE  PROGRAM  13  THE  FEEDBACK  GAIN  MATRIX, 
A  TRANSPOSE,  WHICH  WHEN  MULIIPLIED  BY  THE  STATE  VECTOR 
YIELDS  A  SCALAR  CONTROL. 

THE  FOLLOWING  RECURSIVE  EQUATIONS  WERE  DERIVED  USIN3 
DYNAMIC  PROGRAMMING,  STARTING  AT  THE  TERMINAL  TIME  AND 
WORKING  BACKWARDS: 

(1)  AT  (K)=-(DELT*P(K-1)  *?HI/(DELT*?  (K-1)  *DEL+R 

AT  (0)=0 

(2)  PSI{K)  =PHI  +  DEL*AT(K)  P3I  (0) 

(3)  P(K)  =PSIT(K)  *P(K-1)  *PSI  (K)  +Q+R*A(K)*AT  (K) 

FIRST  ENTER  THE  PROBLEM  IDENTIFICATION 

(*NOT  TO  EXCEED  20  CHARACTERS*).   thesis  exampls 

ENTER  THE  NUMBER  OF  TIME  INTERVALS  (NSTAGE)  OVER  WHICH 

THE    SUM    IS    TO    BE    :i  ADE. 

***     NSTAGE   MUST     BE    ENTERED    IN    13    FORMAT    *** 
***(I.E.,    RIGHT    JUSTIFY    TO    THREE    DIGITS    *** 

ENTER    THE    ORDER    DP    THE    SYSTEM     (UP    TO    8). 
***     ENTER    IN    11     FORMAT    *** 

ENTER    THE    ELEMENTS    OF    THE    0    MATRIX. 

***     ALL    MATRICES    ARE    ENTERED    IN    F-FORMAT    *** 

***     I.E.,    PUT    A     DECIMAL    POINT    AFTER    YOUR    NUMBER    *  ** 

Q  (1r1)= 


ouo 


1, 

0 

Q(1,2)  = 

0 

Q(2,1)  = 

2. 

Q(2,2)  = 

THE  Q  MATRIX 
1.00E+0  0  0.0 
0.0  2.00E+03 

DO    YOU     WANT    TO    CHANGE    ANY    ELEMENT    OF    THE    MATRIX? 


ENTER    THE    VALUE    OF    THE    SCALAR    R 
R    = 


87 


ENTER    THE    SAMPLE    I  NTER  V  AL--DT. 
***     ENTER    DI    IN    F-FORMAT    *** 
.1 

AT    THIS    POINT    YOU    MUST    CHOOSE    DNE    OF    THE    FOLLOWING    OPTIONS 
OPTION    A:    ENTER    THE    NUMBER    0    IF 

(1)  R    IS    FINITE,    C0Sr  =  rERMINAL-HRAJECTORY  +  FUEL, 
OR    IF 

(2)  R    IS    ZER:),    C3ST=rESMINAL+TRAJECT0RY+    0 

OPTION    B;    ENTER    THE    NUMBER     1    IF 

(1)  R    IS    FIJTITE,    C0Sr  =  r2RMINAL-t-    3    ♦■    FUEL, 
OR    IF 

(2)  R    IS    ZERO,    CDST=TEaMINAL    ■♦•    0    +    0 

IF    YOU     WANT    TO    READ    IN    THE    A    AND    B    MATRICES, 

BUT    NOT    THE     PHI    AND    DEL    MATRICES,     ENTER    A    0 

HOWEVER,    IF    YOU    rrfANT    TO    ENTER    THE    PHI    AND    DEL    MATRICES, 
BUT    NOT    THE    A    AND    B    MATRICES,    ENTER    A    1. 


ENTER    THE    ELEMENTS    OF    THE    PLANT    MATRIX--A. 
A(1,1)  = 

A(1,2)  = 

A(2,1)  = 

A  (2,  2)  = 

THE    A     MATRIX    (PLANT    MATRIX) 
0.0  1.OOE+03 

1.00E+0  0      0.0 

DO    YOU     WANT    TO    CHANGS    ANY    ELEMENT    OF    THE    MATRIX? 

ENTER    THE    ELEMENTS     OF    THE    DISTRIBUTION    MATRIX--B. 
B(1,1)  = 

3(2,1)  = 

THE    B     MATRIX    (DISTRIBUTION    MATRIX) 
0.0 
1.  OOE+00 

DO    YOU     WANT    TO    CHANGS    ANY    ELEMENT    OF    THE    MATRIX? 

THE    PHI    MATRIX 

1.0  0  50  03E+00  1.0016573-01 

1.001667E-01  1.005003E^00 

THE  DSL  MATRIX 
5,00416US-03 
1.00  1667E-01 


MINIMIZATION    OVER     ALL    STAGES 
U(       1)      =   AT  (J)  *X(J) 
AT(1)     =      -2.1*63-02 
AT  (2)    =      -1.98S-01 


AT  (2)     = 

AT 
-3 

.91E-01 

U  J      3)     = 
ATM) '  = 
AT  (2)     = 

AT 
-1 
-5 

.55E-01 
.79E-01 

ATbl     = 

AT 
-2 
-7 

(J)  *X(J) 

.5Ue-5i 

.58E-01 

0(      5)     = 
AT(1)     = 
AT  (2)    = 

AT 
-3 
-9 

(J)  *X(J) 

.7DE-!3l 
.29E-31 

U(      6)     = 
AT(1)     = 
AT  (2)     - 

AT 

-4. 

-1 

(J)  *X{J) 

.98S-J1 
.09E+DD 

UJ      7)     = 
AT(1)     = 

AT  (2)     = 

AT 
-6 
-1 

(J    *XiJ) 
.3UE-31 

.24E+a3 

U  (      8)     = 

AT(1         =: 

AT  (2      = 

AT 
-7 

-1. 

.38E+30 

U(      9)     = 
AT(1)     = 
AT  (2      = 

AT 

-9. 

-1. 

(J)  *Xf  J) 

.12E-J1 
.50E+0D 

aj  10)    = 

AT(1)    = 
AT  (2)     = 

AT 

-1. 

-1 

(J)  *Xf  J) 

.05S+30 

.61E+30 

a  J  11)    = 

AT(1)     = 
AT  (2)     = 

AT 

-1. 

-1. 

.  18S  +  JD 

.72E+03 

U(    12)     = 
AT(1)     = 

AT  (2      = 

AT 

-1. 

-1. 

(J)  *Xi J) 

.30E+3D 
.81E-1-33 

Ujf    13)      = 

k'tn)    = 

AT  (2)     = 

AT 
-1  . 
-1  . 

(J)  *XiJ) 
.41E+JD 

.89E+3D 

U(    14)      = 
AT{1)     = 
AT  (2)     = 

AT 
-1, 
-1  . 

(J)  *Xj(J) 

.96E+03 

U(    15)     = 
ATfl)     = 

AT  (2)     = 

AT 
-  1  , 
-2. 

(J)  *X(J) 

.60E+D9 
.022+03 

U(    16)     = 
AT/I)     = 
AT  (2       = 

AT 
-1  . 
'2. 

(J),*XiJ) 

,  boE+OO 
07E+3a 

U(    17)     = 
AT(1)     = 
AT  (2)    = 

AT 
-1  . 

-2, 

(!Jl*XiJ) 

7bE+j3 
12E+3D 

U(    18)      = 
AT(1)     = 
AT  (2)     = 

AT 

-1. 

-2, 

(J)*  1(3) 

82E+a3 
.16E+03 
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n(  19)    = 

ATfl)     = 


AT 


1^!  : 


a(  20)    = 

AT(1)     = 
AT  (2)    = 

U(    21)     = 
ATJI)    = 
AT  (2)     = 

a  (    22)     = 
AT{1)     = 
AT  (2)     = 

U  (   23)     = 
AT(1)     = 
AT  (2)    = 

nj    24)     = 
AT(1)     = 
AT  (2)     = 

Uj(    25)     = 
AT(1)     = 
AT  (2)     = 

U J   26)     = 
AT(1)     = 
AT  (2)     = 

n  (   27)     = 
AT(1)     = 
AT  (2)     = 

U(    28)     = 
AT(I)     = 

AT  (2)     = 

U(    29)     = 
AT(1)     = 
AT  (2)     = 

UJ    30)     = 
AT  (1)     = 
AT  (2)     = 

DJ    31)     = 
AT(1)     = 
AT  (2)     = 

U(    32)     = 
AT(1)     = 
ATb)     = 

UJ    33)     = 
AT{1)     = 

AT  (2)     = 

UJ    34)     = 
AT(1)     = 
AT  (2)     = 

^4    i^) 
AT(1)     = 

ATb: 


AT  (J)  *X(J 

-1.88E+00 
-2.20E+3D 

AT  (Jl^*Xf  J 
-1.93E^:D 
-2.23S-»-00 

AT  (J)  *XiJ 
-1.97E*3o 
-2.25E+aO 

AT  (J)  *X{J 

-2.01E+00 
-2.27E+00 

AT  (J)  *Xj(J 
-2.04E^•00 
-2.29E■^^D 

AT  (J).*Xf  J 
-2.07E+33 
-2.31E+D3 

AT  (J)  *XiJ 
-2.09E+J3 
-2.32E+30 

AT  (J)  *Xf  J 
-2.  IIE  +  OD 

-2,34E+D0 

AT  (J),*X(J 
-2.13E  +  ()0 
-2.35E+30 

AT  (J)L*XiJ 
-2.  15S  +  J0 

-2.35E+30 

AT  (J)  *XiJ 
-2. 15E+J3 
-2.36E-^^^ 

AT  (J)l,*Xi(J 

-2.  17E  +  00 
-2.37E+33 

AT  (J)  *xrj 

-2.18E+J3 
-2.37E+3D 

AT  (J)  *X(J 
-2.19E+J3 

-2.38E+33 

AT  (J)  *XiJ 
-2.20E+5D 
-2.38E+30 

AT  (J)  *Xf  J 
-2.20E-I-JD 
-2.39E+D3 

AT  (J)  *X(J 
-2.21E+3  3 

-2.39E+33 
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AT(2)  =   -2.39E  +  33 

0  (  37)  =  AT  (J)  *X(J 
AT(1)  =  -2.22E  +  (5a 
AT  (2)  =   -2.39E  +  03 


3  8)  =  AT 


*X(J 


AT(i)'=  -2;22E  +  3a 
AT  (2)  =   -2.U0E  +  33 

0  (  39)  =  AT  (J)  *XiJ 
AT(1)  =  -2.22E  +  J3 
AT(2)  =   -2.40E■^^^ 

U(  UO)  =  AT  (J)  *XiJ 
AT(1)  =  -2.23E+J3 
AT(2)  =   -2.40E  +  33 

THIS  CONCLUDES  THE  OPriMAL  lONTROL  PRD3RAM  (OPTCON) . 
DO  YOa  WANT  TO  RUN  THE  PROGRAM  AGAIN?   n 

ANALYSIS  IS  COMPLETE.   DO  YDJ   WANT  TO  RUN  LINCON  A3AIN? 
n 

LINCON  IS  NOW  lERaiNAPED. 

The  results,    shown  in   Appendix  J,         indicate  that 
steady  state  gains  ars  achievrd  at  about  -2.23  and  -2.4. 
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V-   CONCLgSIONS  AND  RECOMMENDAriONS 

A.   CONCLUSIONS 

Although  LINCOM  vfas  rfrizten  primarily  as  a 
teaching/learning  tool,  it  can  still  be  ^aite  useful  tD  the 
practicing  engineer  fDr  design  and  analysis  problems.  It  was 
written  in  modular  form  so  that  it  could  bs  easily  modified 
by  the  addition  of  subroutines. 

LINCON  has  been  extensivsly  tested  in  an  advanced 
op-cimal  estimation  courss.  Ths  interactive  aspects  proved 
highly  successful.  Hopefully  all  the  "bugs"  have  been 
eliminated. 

As  stated  earlier,  althougi  the  original  intent  of  this 
thesis  was  to  adapt  Dasjardins*  version  of  Melsa's  LINCON  by 
making  it  interactive,  LINCDM  began  to  grow  as  other 
routines  were  added  and/or  exteisively  modified. 

OPTCON,  the  optimal  control  prograi  using  recursive 
eguations  derived  froa  dynamic  programming,  is  a  new  member 
to  the  LINCON  family.  Desjardins'  KALMAN,  the  discrei:?  -ime 
Kalman  filter  progran,  underwsnt  considerable  programming 
changes  before  achieving  i -s  present  form. 
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B.   EECOMMENDATIONS 

(1)  The  source  puDgram,  LISCON  FORTRAN  A1,  must  now  be 
passed  from  user  to  user  and  ti=n  corapilei  before  it  can  be 
used.  As  can  be  sesa  in  the  tairminal  session  examples,  the 
program  was  invoked  by  typing  "iincon".  Actually,  this  is 
an  executive  progran,  LINCOM  EXEC  A1,  comprising  of  the 
following  statements: 

FILEDEF  09  PRINTER  (RECFM  FA  LRECL  133  BLOCK  133 

LOAD  LINCON  (START 

The  first  statement  iafinas  09  is  the  printer  and  permits  it 
to  print  out  133  charictsrs  per  line.  Tha  second  statement 
invokes  the  compiled  /ersion  of  LINCON.  It  is  recommended 
that  LINCON  be  placed  on  a  utility  disk  so  that  users  may 
link  to  it  instead  of  the  curra.it  procedurs. 

(2)  At  times  it  can  b=  exceedingly  difficult  to 
interpret  the  tabular  output  of  some  of  ths  programs.  It  is 
recommended  that  a  graphics  package  be  devsloped  for  RIRESP, 
RICATI,  KAL21AN  and  OPT  CON.  The  package  should  be  interactive 
with  the  output  being  first  displayed  on  the  terminal  screen 
and  then  allowing  ths  user  to  ohoose  ths  type  of  output, 
i.e.,  VERSATEC,  TEKTRONIX  or  pri:it-plct. 
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(3)  In  general,  the  programs  are  limited  to  eighth-order 
problems.  If  the  nead  should  arise  to  s^lve  higher  order 
systems,  this  liaiiation  may  be  removed  by  extending  the 
appropriate  dimension  statements.  The  user  must  remember  to 
alter  the  format  statsment  pertaining  to  the  output,  either 
decreasing  the  significant  figures  or  adding  a  "wrap-around" 
feature  to  overcoma  the  printer  limitations  of  133 
characters    per    lina. 

(4)  As  it  is  written,  LUEN  can  only  solve  for  a 
reduced-order  observ=r.  It  is  racommendei  that  the  program 
be  modified  so  that  the  aser  has  the  option  of  selecting  a 
reduced-order    observer    or   an   id=Qtity   observer. 

(5)  The  ficticious  and  r=al  c  matrices  of  SIVAR  are 
required  to  have  ths  dimensions  1  x  n.  It  is  recommended 
that  the  program  bs  modified  to  accept  a  dimension  siz2  of  m 
X  n. 
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APPENDIX    A 

BASIC    MATRIX    PRDGRAM 

PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

3(c:)c4c****4c4(4c44c**:«e*«4c4c4c>ic  ****************  ***:«t  ***********  ***  *** 

THE    A    MATRIX 

1.000000E+00  0.0  0.0 

0.0  -2.000D0DS+00  1.000000E+00 

0.0  -5.  OOOOODE-01  1. 0000OGE-»-OO 

THE    DETERMINANT    OF    THE    MATRIX 
-1.5  COO  OOE+00 

THE    INVERSE    3F  THE    MATRIX 

1.0  000  00E-»-00  0.0  0.0 

0.0  -6. 665555E-01  6.556665E-01 

0.0  -3. 333333E-01  1.333333E+00 

******************************4t  4c*******  **********  ********* 

THE    MATRIX    COEFFICIENTS    3F    THE    NUMERATOR    OF    THE 

PHI(S)    MATRIX 

THE    MATRIX    COEFFICIENT    OF    3**2 

1.000000E>00  0.0  O.D 

0.0  1.000000E+00  0.0 

0.0  0.0  1.000000E+00 

THE    MATRIX    COEFFICIENT    DF    S**1 

1.000000E+00  0.0  0.3 

0.0  -2. OOOOOOE+OO  1.000000E+00 

0.0  -5.00030DE-01  1.000000E+00 

THE    MATRIX    COEFFICIENT    3F    S**0 
-1.5C00  OOE+00  0.0  0.3 

0.0  1.000000E+00  -1.000000S+00 

0.0  5.000303S-01  -2. 330000 E+00 

*******  **  *  ***  ******4c*  **  *********************************** 

THE    CHARACTERISnC    POLYNO^  lAL-IN    ASCENDING    POWERS    0?    S 
1.500000E+00         -2.  500003E+30  0.0  1.000000E  +  00 

*****  ****  *  ***  ********  **********  **********************:y*  **** 

THE    EIGENVALJS5     OF    THE    A    lATRIX 
REAL    PART  IMAGINARY    PART 

8.  2  287  55S-0  1  0.0 

-1.  822876S<-a0  0.0 

1.3  000  00E+00  0.0 

**********  ***********  ************************************* 

THE    ELEMENTS    OF    THE    STATE    TRANSITION    MATRIX 
THE    MATRIX    COEFFICENT    OF    EXP (  8. 228755E-0 1)  T 

0.0  0.0  0.0 

0.0  -6.69U317S-02  3.779633E-01 

0.0  -1. 389811E-01  1.0669U5E+00 

THE    MATRIX  COEFFICENT    OF    EXP(         -  1 . 322875 S  +  00) T 

0.0  0.0                                   0.0 

0.0  1.0669U4E4-00         -3.7796aiE-01 

0.0  1.889823S-01         -6. 6 9a669S-02 

THE    MATRIX    COEFFICENT  OF    EX?(            1 . OOOOOOE+00) T 

1.000000E+00  0.0                                   0.0 

0.0  -2. 264977E-06            2.351023E-06 

0.0  -5. 36441BE-07            1.07288aS-06 
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APPENDIX    B 

PABTIAL    FEACriDN    EXPANSION 

PROBLEM    IDENriPICATION;  THESIS    EXAMPLE 

THE    INPUT    FDNCnON    SAIN 
7.  OCOOOOE+00 

Hi  :ii:4i:ic:ii4i*  *************  in  ************************************* 

NUMERATOR    COEFFICIENTS    -    IN    ASCSNDIN3    POWERS    OF    S 
2.0000E4.00  2.3300EfOO  1.0000E  +  00  1.0000E  +  00 

NUMERATOR    R03T3  ARE 

REAL   PART  IMAG.     PART 

0.0  -1.  414213E+00 

0.0  1.1^  14213E+00 

-1.  OOOOOOE+00  0.0 

********************************************************** 

THE    INPUT    FUNCTION    3AIN 
7.  OOOOOOE+00 
********* **********iii*  *********^************************  *** 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
2.000E•^00  I.OOOE^-OO  0.0  3.000E  +  00  I.OOOE-^00 

DENOMINATOR    RODTS    ARE 

REAL    PART  IHAG.     PART  MULTIPLICITY 

-3.0  18859E+00  0.0  1 

-9.  1  276  04E-0  1  0.0  1 

U.658098E-01         -8.  308'4  27  E-0 1  1 

U.658098E-01  8.308427E-01  1 

*********************  **^^*****iii  *********************  ****** 

RESIDUE    MATRIX    -    REAL    PART 
5.8  10872E+00 

3.  1  70837E-01 

4.  360231E-01 
4. 3  602  3 1S-01 

RESIDUE    MATRIX    -     IMAG.     PART 
-2.050349E-07 
0.0 
2.  061406E+00 

-2.  061406E+00 
*** ******  ************ *********^  ********************* *** *** 
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APPENDIX    C 

ROOTS    OF    A    POLfNOMIAL 

PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

4c:4c:4c«:4c:ic:«c:4c:^:^i4c4c**4c:«c4c4c:«c«4c  **********************************  **** 

POLYNOMIAL   COEFFICIENTS    -    IN    ASCENDIN3    POWERS    OF    S 

8.0000E-01  5.1000E+0D  3.0000E+00  1.0000S+00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-1.413221E+00  1-616248E^00 

-1.U13221E+00         -1.6162U8E+30 
-1.73556aE-01  0.0 

********************************************************** 
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APPENDIX    D 

RATIONAL    TIME    RESPONSE 

PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

THE    A    MATRIX     fPLANT    MATRIX) 

1.0COOOOE+30  0.0  0,0 

0.0  -2.000000E+00  1.000000E+00 

0.0  -5.000303E-01  1.000000S+00 

THE    B    MATRIX     (CONTROL    VECTOR) 
0.0 
0.0 
1.0  000  00E-I-0  0 

THE    C    MATRIX     (DaTPUT    VECTDR) 
1.  OOOOOOE^OO 

a.  ooooooE-01 

1.0COOOOE+00 

THE    FEEDBACK    COEFFICIENT    SECTOR 
1.  OGOOOOE+OO 
1.0  000  00E+00 
0.0 

THE    CCNTROLLER    3AIN 
3.  2  000  00E+00 

**************4c:^*****#**:(c4t*****  ********************  ******* 

INITIAL    CONDITIONS    i^SCTOR-X(O) 
0.0 
0.0- 
0.0 

THE    I^IPUT    FUNCTION    3  AIN 
5.000DOOE-01 

NUMERATOR    POLYNOMIAL    OF    R(5)  -ASCENDINS    POWERS    OF    S 
1.000000E+00  I.OOOOOJS  +  00 

NUMERATOR    ROOTS     ARE 

REAL   PART  IMAG.     PART 

-1.  OOOOOOE+00  0.0 

DENOMINATOR    POL'fNOMIAL    OF    R  (S)     -    ASCENDING    POWERS    OF    S 
-2.  OOOOOOE+30  0.0  1.000000E+G0 

DENOMINATOR    ROOTS  ARE 

REAL   PART  IMAG.     PART 

1.4  1421  3E^-00  0.0 

-1.  4  14213E+30  0.0 

***************:}£  *:ic******«*******:«c***********:«t:4c******  ****** 

THE    TIME    RESPONSE    OF    THE    3TATS    X  (T) 

VECTOR   COEFFICIENT    OF    EXP ( -5 . 00 E-0 1 )  r*COS  ( 1  .2 OE  +  00 ) T 
0.0  -3. 695463S-01         -9. 7 1 76 97E-0 1 


VECTOR   COEFFICIENT    DF    EXP ( -5 . OOE-0 1 )  T*SINi 1 . 20E  +  00  )  T 
0.0  -3. 465745E-01         -7. 5 0 2007 E-02 

THE    VECTOR    COEFFICIENT    OF    EX? (  1 .  0000 OOE  +  00)  T 

0.0  0.0  2.582209E-06 

THE    VECTOR    COEFFICIENT    OF    EX?i  1 .  4  1  42 1  3S  +  00)  T 

0,0  2.570373S-0t  9.117225E-01 

THE    VECTOR    COEFFICIENT    OF    SXPr         -  1 .  4  1  42  1  3E  +  00)  T 
0.0  1.025083E-0T  6.304864E-02 

*****  it*  **:^*****:^c**:«c*  ********************************  ****** 
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THE    TIME    RESPONSE    OF    THE    DQIPUT    YfT) 

THE    COEEFICIENT    OF    EXP  (-5  .  00  OOE-Q-t)  1*303  ( 1  .  204  1E  +  0  0)  T 
-1.  1  19588E+00 

THE   CCEFFICIENr    OF   EXP (-5. 3 0 OOE-01) T*SIN ( 1 . 20aiE+0 0) T 
-2.  1  36900E-01 

THE   CQEFFICIENr    OF   EXP (  1 . OOOOOOE+00) T 

2.  6  82209E-06 

THE    COEFFICIENT    OF    EXP (  1 . 4 1 421 3E+00) T 

1.0  18537E-f00 

THE   COEFFICIENT    OF    EXP (         -  1 . 4 1 421 3E  +  00) T 
1.0  10521E-01 

:)c«j^*:f  :4c4c4c:4c4c4nt(4cXc**:4c4c*«4c  ************************************* 
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APPENDIX    5 

OBSERVABILITY,    C ONTROLLABILIIY 

PROBLEM    IDENriFICATION:  THESIS    EXAMPLE 

:ie 4e :«(*:«(««  4c :ie  *  4a4e«4:  :4c :«c]Oc  4c  :«c:(c«  ^c^c^c*  4c  4c3)c*  4t>)c  *  *  4c4<:4c  *  «4e  **4c4(  4e  ^c^c**  4c*4c4:  *4c4c  *** 

THE    A    MATRIX     (PLANT    MATRIX) 

0.0  1.  OOOOOOE+03  0.0 

-1.000000E+00        -5.  OOOOOOE-01  I.OOOOOOE  +  OO 

0.0  0.0  1.000000E+00 

THE    B    MATRIX 

2.000000E+00  1.000D00E+0D 

0.0  1.000300E+0D 

0.0  3.0 

THE    C    MATRIX 
0.0  1.OOOOOOE+00  0.0 

I.OOOOOOE^OO  I.OOOOOOE+O:  0.0 

-2.  OOOOOOE+00  1.OOO0OOE+O0  0.0 

********************************************************** 

OBSERVABILITY    ISDEX    =       2 

THE    SYSTEM     (A,B|      IS    UNCONTROLLABLE 
*********************  **********************************  *** 
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kPP^MDIX    F 

OPTIMAL    CONTROL/CONriNUDaS    KALMAN    FILTER    PROGRAM 
PROBLEM    IDENTIPICATION:  THESIS    EXAMPLE 

:lc:(c4c:«c4c  4c*  ^:4c  ******  :«c*4c*4e4c  **********************************  *** 

THE    A    MATRIX     (PLANT    MATRIX) 
-1.000000E+00  3.0 

0.0  -2. OOOOOOE+OD 

THE    B    MATRIX     (DISTRIBUTION    MATRIX) 
1.000000E+00  3.0 

0.0  1.000300E+0D 

THE    C    MATRIX     (MEASUREMENT    MATRIX) 
1.000000E+00  3.0 

0.0  2.  OOOOOOE+33 

**:^#4c*****  ***********  **:4c***:4c**4c  *********************  ****** 

THE    R    MATRIX     (CONTROL    WEIGHTING    MATRIX) 
1.000000E+00  3.0 

0.0  2. OOO3OOEV03 

THE    Q    MATRIX     (STATE    WEIGHTING    MATRIX) 
I.OOOOOOE+OO  1.000300E>03 

1.00000CE+00  1.000000E+03 

******  *****:Jt:«c****  ****  * 

***    CONTROL    OPTION    *** 

**:tti4c**  4c**********  ***** 

THE    P    MATRIX     (TERMINAL    BOJNDARY    VALUE    MATRIX) 
0.0  3.  0 

0.0  3.0 

*******************************   *******3!c*5!t******4t*5)t*  ******* 

TRANSIENT    SOLUTION 
TIME    =       1.000E+31 

GAINS 
0.0  0.0 

0.0  0.0 

TIME    =      9.000E>33 
GAINS 
3.7i45150E-01  2.  80837UE-01 

1,404037E-01  1. 112729E-01 

TIME    =      8.000E+33 
GAINS 
3.982797E-01  2.8a9711E-31 

1.U24856E-01  1.  1172  60E-01 

TIME    =      7.000E+33 
GAINS 
3.997058E-01  2.8U7993E-01 

1.a23996E-01  1.117371S-01 

TIME    =      6.000E+33 
GAINS 
3.997959E-01  2,8U7759E-01 

1.423879E-01  1.117399E-01 

TIME    =      5.000E+33 
GAINS 
3.997999E-01  2.8U7756E-01 

1.423877E-01  1.117399S-01 

TIME    =      U.OOOE+33 
GAINS 
3.997999E-01  2.8U7756E-01 

1.U23877E-01  1.117399E-01 
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TIME    =      3.000E+00 
GAINS 
3.997999E-01  2.  8a7756E-01 

1.423877E-01  1.117399E-01 

TIME    =      2.000E+DO 
GAINS 
3.997999E-01  2.8a7756E-01 

1.U23877E-01  1.117399E-01 

TIME    =      1.000E+DD 
GAINS 
3.997999E-01  2.  8U7756E-01 

1.a23877E-01  1.  117399E-01 

TIME    =      2.861E-35 
GAINS 
3.997999E-01  2.8a7756E-01 

1.423877E-01  1.117399E-01 

:ec«4:****:4e*4c*4c:«c4c*4c:«'4c4c4c*  ****  ******************************  *** 

***    FILTER    OPTI^^I    *** 

THE    P    MATRIX     (I!?ITIAL    BDUflDARY    VALUE    MATRIX) 
0.0  3.0 

0,0  0.0 

*  **  :«(:)( :4c  :tc  4c:4e  :tc  :^4eic:(c:;ic:^4c4c4c4e4e  ****  **;{t********5}c  ******  ************  *** 

TRANSIENT    SOLUnON 
TIME    =      0.0 

GAINS 
0.0  0.0 

0.0  0.0 

TIME    =      5.000E-31 
GAINS 
2.393162E-01  2.004539E-01 

8.018157E-01  5.8a9594E-31 

TIME    =      1 .OOOS+OD 
GAINS 
2.708317E-01  2.  1279U1E-01 

8.511767E-01  7.053521E-01 

TIME    =      1. 500S+30 
GAINS 
2.768U88E-01  2.  133181E-01 

8.53272aE-01  7.055743E-01 

TIME    =      2.GOOE+D0 
GAINS 
2.78a715E-01  2.  132589E-01 

8.53035UE-01  7.0558U3E-D1 

TIMS    =      2. 500E+00 
GAINS 
2.789688E-01  2.  132211E-01 

8.528843E-01  7.055938E-01 

TIME    =      3.000E+00 
GAINS 
2.791271E-01  2.  13207aE-01 

8,523297E-01  7.055972E-01 

TIME    =      3. 5OOE+0O 
GAINS 
2.79178  1E-01  2.  132027E-01 

8.528109E-01  7.055984S-01 
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TIME    =      4.000E+3D 
GAINS 
2.791938E-01 
8.528078E-01 


2.  132D20E-01 
7. 055986E-01 


TIME    =      U.500E+3D 
GAINS 
2.791983E-01 
8.  52  80  7  OE- 01 


2.  132018E-01 
7. 055986E-01 


TIME    =      5.0O0E+33 
GAINS 
2.791983E-01  2.  132318E-01 

8,528070E-01  7.  055986E-01 
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APPENDIX    G 

DISCRETE    TIME    KALMAN    FILTER    PROGRAM 
PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

THE    PHI    MATRIX    (TPANSITLD?!    MATRIX) 
1.000000E+00  5.000300E-01 

0.0  1.000000E*03 

THE    GAMMA    MATRIX     (DISTRIBailON    MATRIX) 
1.250000E-01 
5.000000E-01 

THE    W    MATRIX     (1EAN-SQUARS    MAGNITUDE    OF    THE 
PERTURBATION    ACCELERATION    MATRIX) 
4.000000E+00 

THE    H    MATRIX     (OBSERVATION    MATRIX) 
1.00000CE+00  3.0 

THE    R    MATRIX     ()1S  ASUREMSNT    NOISE    COVARIANCE    MATRIX) 
5.00  00  0  0E+0  0 

THE    P    MATRIX     (INITIAL    CONDITION    MATRIX) 
1.000000E+03  3.0 

0.0  1.000300Ef03 

*******  **  *  ifO**  ********  *i^**:fii**i^^^  *i^::^******:ff****:l^:ii*  *******  *** 

K    =         0 
GAINS 
9.950248E-01  3.0 

K    =         1 
GAINS 
9.807723E-01  1.923759E+03 

K    =         2 
GAINS 
8.290299E-01  9.980751E-01 

K    =         3 

GAINS 
7.028207E-01  5.237227E-01 

K  =       a 

GAINS 
6.134719E-01  4.522047E-01 

K    =         5 
GAINS 
5.543699E-01  3.716016E-01 

K    =         6 
GAINS 
5.184991E-01  3.362513E-01 

K    =         7 
GAINS 
4.992278E-01  3.232393E-01 

K    =         8 
GAINS 
4.904468E-01  3.201340E-31 

K    =         9 
GAINS 
4.872549E-01  3.202326E-01 
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K    =       10 
GAINS 
U.  86440  0E-01 

K    =       11 
GAINS 
4.  863a75E-01 

K    =       12 
GAINS 
U.  863U56E-01 

K   =       13 

GAINS 
4.8629UUE-01 

K    -       Mi 
GAINS 
U,  86216  8E-01 

K   =       15 

GAINS 
a.  86  1480E-01 

K    =       16 

GAINS 
a.  861035E-01 

K    =       17 
GAINS 
4.860806E-01 

K    =       18 
GAINS 
4.  86071  2E-01 

K    =       19 

GAINS 
4.860685E-01 

K    =       20 
GAINS 
4.  86  06  8  OE- 01 


3. 207918E-01 
3.  210392E-01 
3.  2099  99E-01 
3.  20  35o3S-01 
3.  2072  75E-01 
3.  2061*  94E-01 
3. 206143E-31 
3.  206035E-01 
3. 206024E-01 
3. 206034E-01 
3. 206041E-01 


**********:Mt******************«t  *********************  ****** 
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APPENDIX    H 

STAIE    VARIABLE    FEEDBACK    PSDGRAM 

?ROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

*******************************  ************************  *** 

THE    A    MATRIX     (PLANT    MATRIX) 

-1.0  COOOOE+00  1.00030DE  +  00  0.3 

0.0  0.0  1.000000E+00 

0.0  -3.00000DE+00  0.0 

THE    B    MATRIX     (CONTROL    MATRIX) 

0.0 

0.0 

1.  OOOOOOE+00 
********************************************************** 

OPEN-LOOP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
3.0000E+00  3.0300E*00  1.0000E+00  1.0000E+00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

3.3  -1.732051E+00 

0.3  1.732051E+00 

-1.300000E■^00  0.0 

********************************************************* 

THE    C    MATRIX     (FICTICIOUS    DUTPUT    VECTOR) 

0.  0 
0.0 

1.  0GO0OOE■^O0 

NUMERATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
0.0  1.000303E+00  1.000000S+00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-1.300000E+00  0-0 

3.3  0.0 

********************************************************** 

THE    C    MATRIX     (DJTPUT    VECTOR) 
1.0C0O00E+0O 

1.  OOOOOOE+00 
0.0 

NUMERATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 

2.  OGOOOOE+0  0  1.000003E+00 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-2.300000E+OC  0.0 

**********  ***********  ************************************* 

CLOSED-LOOP    CALCULATIONS 
KTIY    —    P  ***** 

THE    NUMERATOR    OF     H-EQUI7ALENT    - 
IN    ASCENDING    POWERS    OF    3 

5.000C00E-31  1.5OO0O3E  +  OO  1.50000GS  +  00 

THE    ROOTS    ARE  REAL    PART    IMAG.     PART 

-5.30JOOOE-01         -2.336756E-01 
-5.300000S-01  2.886756S-01 

THE    FEEDBACK    COEFFICIENTS 

5.000000E-01  0.0  1.530000E+00 

THE    GAIN    =  2.0003  00E  +  03 

THE    CLOSED-LOOP     CHARACTERISTIC    POLYNOMIAL    - 
IN    ASCENDING    POWERS    OF    3 

4.0000E+00  6.0000E^33  U.OOOOEfOO  1.0000E+00 
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THE    ROOTS    ARE                    REAL    PART    IMAG.  PART 

-2,300000E+00  0.0 

-1.300000E+00  -1.000000E+00 

-1.303000E+00  1.000000E+00 

MAXIMUM    NORMALISED    ERROR    =       0.0 
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APPENDIX    I 

STATE    VARIABLE    FEEDBACK    PRDGRAM 

PROBLEM    IDENTIFICATION:  THESIS    EXaMPLE 

********************* **********************************  *** 

THE    A  MATRIX     fPLANT    MATRIX) 

0.0            1.000000E+00           :.D  0.0 

0.0              0.0                                 1.000000E+00  0.0 

0.0              0.0                                 0.0  I.OOOOOOE-^00 

0.0           -1.5O0DOOE4-O1         -2.300000E>01  -9.  OOOOOOE+OO 

THE    B    MATRIX     (CONTROL    MATRIX) 
0.0 
0.0 
0.0 

1.  OOOOOOE+OO 
********************************************************** 

OPEN""  LOOP    CALCULATIONS 

DENOMINATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
0.0         1.500S+D1       2.300E«-01       9.000E  +  30  1.0G0E+30 

THE    ROOTS    ARE  REAL    PART  IMAGINARY    PART 

-3.DOOOOOS+00  0.0 

-U.999999E+00  0.0 

-9.999999E-01  0.0 

0.3  0.0 

*********************************************************** 

THE    C    MATRIX     nUTPUT    VECTDR) 

2.  OOOOOOE+OT 
1.0G0300E+01 
0.0 

0.0 

NUMERATOR    COEFFICIENTS    -    IN    ASCENDING    POWERS    OF    S 
2.000000E+D1  1.00000jE  +  01 

THE    ROOTS    APE  REAL    PART  IMAGINARY    PART 

-2. OOOOOOE+OO  O.O 

**********  ***********  ************************************ 

CLOSED-LOO?    CALCULATIONS 
KEY    =    ^  ***** 

THE    NUMERATOR    OF     H-EQUI7 ALENT-IN    ASCENDING    POWERS    OF    S 
2.000E+01  1.300S+01  -6.000E+00         -3.000E+00 

THE    ROOTS     ARE  REAL    PART    IMAG.     PART 

-1.D39623E+00  0.0 

3.206289E+00  0.0 

THE    FEEDBACK    COEFFICIENTS 

2.000S+01  1.300E+Q1         -6.000E+00         -3.000E+00 

THE    GAIN    =  1,  OOODOOE+0) 

THE    CLOSED-LOOP     CHARACTERISTIC    POLYNOMIAL 
IN    ASCENDING    POWERS    OF    S 
2.000E+01         2.300S+01  1.703S+01         6.000E+00         1.000E+0G 

THE    ROOTS    ARE                     REAL    PART    IMAG.  FART 

-1.300aOOE+00  -2.000000S+00 

-1.D00000E+00  2. OOOOOOE+OO 

-2.D0048as+00  0.0 

-1.999516S+00  0.0 

MAXIMUM    NORMALIZED    ERROR    =       0.0 

OBSERVABILITY,    CONTROLLABILITY 

PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

1D3 


4c  «4(  **«««*«  ***********  *********{:*****«♦******************** 

THE    A    MATRIX     (PLANT    HATRIXt 

0.0                        1.0030002*00           0.0  0.0 

0.0                       0.0                                  I.OOOOOOE^OO  0.0 

0.0                       0.0                                 D.O  1. 000000  E-«-00 

0.0                     -1.5030 OOE+01         -2.300000E+01  -9. OOOOOOE+00 

THE    B    MATRIX 
0.0 
0.0 
0.0 
I.OOOOOCE^-00 
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HE    C    MATRIX 

OOOOCE+00  0.0  0.0  0.0 


0.0  1.  OOOOOOE+03  0.0  0.0 

*********************  **jjc*  ******  *«4t********  *******  ********* 

OBSERVABILirr    rSDEX    =       3 

THE    SYSTEM     (A,3|      IS    CONTROLLABLE 
**************  *******  ************************************* 


LUENBER3SR   OBSERVER    DESIGN    PROGRAM 

PROBLEM    IDENTIFICATION:  THESIS    EXAMPLE 

**********  ***********  ************************************* 

THE    A  MATRIX     {PLANT    MATRIXJ 

0.0  1.0a0300E+00            3.0  0.0 

0.0  0.3                                  1.000000E+00  0.0 

0.0  0.0                                   3.0  1.000000E+00 

0.0  -1.503300E+01         -  2. 300000E+01  -9 . 000000 E  +  00 

THE    B    MATRIX     (DISTRIBUTION    MATRIX) 
0.0 
0.0 
0.0 
1.0C00  00E+00 

THE    C    MATRIX     fOJTPUT    MAIRIX) 

1.0COOOOE+00  0.0  0.3  0.0 

0.0  1.000000E+00  0.0  0.0 

THE    DESIRED    FEEDBACK    COEFFICIENTS 

2.000000E+31 

1.3C0000E+01 

-6.  OCOOOOE+00 

-3.  OCOO  OOE+00 

OBSERVER    EIGENyALOES  REAL    PART  IMAG.     PART 

-3.500000E+00  0.0 

-4. OOOOOOE+OO  0.0 

OBSERVER    CHARACTERISTIC    POLYNOMIAL 
COEFFICIENTS    IN     ASCENDING    POWERS    OF    3 

1.4C0000E+01  7.5003033  +  00  1. OOOOOOE+OO 

THE    F    MATRIX     (OBSERVER    EIGENVALUE    MATRIX) 
-7.  5GOO0OE+0O  1.000303E+00 

-1.400000E+01  0.0 

THE    G1    MATRIX     (OBSERVER    GMN    MATRIX) 
8.5  499  97E+3  1  2.92a994E  +  01 

0.0  0.0 

THE    G2    MATRIX     (OBSERVER    GMN    MATRIX) 
-2.  999997E+00 
-1.  5000  01S+00 
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OUTPUT   FEEDBACK 
2.  OOOOOOE^OI 


COEFFICIEiirS 
8.500004S+00 


COMPENSATOR    FEEDBACK    COEFFICIENTS 
1.000000E+00  0.0 
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APPENDIX  J 

OPTIMAL  CONTROL  PP03RAM 

PROBLEM  IDENriFICATION:      THESIS  EXAMPLE 

THE  NUMBER  OF  TIME  INTERVALS  =    40 

THE  ORDER  OF  THE  SYSTEM  =  2 

THE    Q    MATRIX 

1.0C0000E+00  0.0 

0.0  2.00000DE  +  00 

THE    SCALAR    R    =  1. 

THE    SAMPLE    INTERVAL    (DT|     =  0.1000 

THE    A    MATRIX     (PLANT    MATRIX) 
0.0  I.OOOOOOE^-OO 

1.  OCOOOOE-t-0  0  0.0 

THE    B    MATRIX     (DISTRIBUTION    MATRIX) 
0.  0 
1.000000E+90 

THE    PHI    MATRIX 

1.005003E+00  1.001567E-01 

1.001667E-01  1.005003S+00 

THE  DEL  MATRIX 
5.  0  04164E-03 
1.001667E-01 

MINIMIZATION    OVER     ALL    STAGES 

U  (      1)     =    AT  (J)  *Xi  J) 
AT(1)     =      -2.a6E-32 
AT  (2)      =      -1.98E-01 

Uf      2)     =    AT(JL*XfJ) 
A1!(^)     =      -7.72E-02 
AT(2j     =      -3.91S-01 

U(      3)     =    AT(J)*X1J) 

AT(2i     =      -5.79E-D1 

U  (      4)     =    AT(J)  *Xi  J) 
AT(1)     =      -2.5UE-()1 
AT(2)      =      -7.58E-01 

U(      5)     =    AT(J)*XiJ) 
AT(1)      =      -3.7DE-0  1 
AT(2|      =      -9.29S-D1 

U(      6)     =    AT(J),*XiJ) 
AT(1)      =      -4.98E-J  1 
AT(2)     =      -1.09E<-30 

U  (      7)     =    AT(J)  *Xi  J) 

AT(2)     =      -1.2^E^30 

U(      8)     =    AT(J)  *X(  J) 
AT(1)      =      -7.7US-31 
AT(2)      =      -1.38E^0O 
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U(      9)    = 
ATd 


AT 


Ui  : 


U(    10)     = 
AT(1)     = 
AT(2i     = 

U(    11)     = 
AT(1)      = 

AT(2)      = 

U(    12)    = 
AT(1)      = 
AT  (2)      = 

0(    13)     = 

AT(2i     = 

U(    1U)     = 
AT(1)      = 
AT(2)      = 

U(    15)     = 
AT(1)     = 
AT(2(      = 

U(    16)     = 
AT(1)     = 
AT(2i      = 

U(    17)     = 
AT(1)      = 
AT  (2)      = 

U(    18)     = 
AT(1)      = 
AT(2)      = 

Ujf    19)     = 
AT(1)      = 

AT(2i      = 

U(    20)     = 
AT(1)      = 
AT(2i      = 

U(    21)     = 
AT(1)      = 

U(    22)     = 
AT(1)      = 

AT(2)      = 

U(    23)     = 
A^(1)     = 

AT(2)      = 

aj    2U)     = 
AT(1)      = 
AT  (21      = 

U(    25)     = 
AT^I)      = 
AT  (2       = 


AT 
-9 
-1 

AT 
-1 
-1 

AT 
-1 
-1 

AT 
-1 
-1 

AT 
-1 
-1 

AT 
-1 
-1 

AT 
-1 
-2 

AT 

-  1 
-2 

AT 

-  1 

-2 

AT 
-1 
-2 

AT 
-1 
-2 

AT 
-1 
-2 

AT 
-1 

-2 

AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 
-2 


50E+00 
J)  *Xi  J) 
61Ef DO 

J)  *xr J) 

IBE+aO 
72Ef00 

J)  *Xi  J) 

30E*30 
81S+00 

J)  *xr J) 

UIE^OO 
89S<-00 

J)  *xr  J) 

51E>00 
96E+3  0 


)  *Xi  J) 

0E*-J0 


J 
6 
02S<-30 


68Sf  30' 
07E+00 

J)  *Xi J) 

75Ef30 

12Ef30 


JL*Xi  J) 

82E>'30 

16E<-D0 


lU'-' 


88Ef  00' 
20S<-D0 


JL*Xi  J) 
93Ef  JO 
23E+0  0 

JL*xi  J) 

97Ef  JO 

25E1-30 

J)  *Xi  J) 

OIE^JO 
27EfOO 


J)  *Xi  J) 

OUE^JO 
29Sf  00 


hiJ^i' 


J 

0 
31E+D0 


J)  *X(  J) 

09EfOO 

32E<-0  0 
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Ui    26) 
AT(2( 

Olf   27)    = 
AT{1)     = 
AT  (2)     = 

U(    28)     = 
AT(1)      = 
AT  (2)     = 

U(    29)     = 
AT(1)     = 
AT(2)     = 

U(    30)     = 
AT(1)     = 
AT(2!     = 

Uj(    31)    = 
AT(1)     = 
AT  (2)     = 

U(    32)    = 
AT(1)      = 
AT(2i     = 

U(    33)     = 
AT(1)     = 
AT(2)     = 

U(    3a) 

AT(1) 

AT(2 


=      -2 


AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 
-2 

AT 
-2 

-2 

AT 
-2 
-2 


U(    35) 
AT(1) 
AT    2 


U(    36) 
AT(1) 

U(    37) 
AT(1^ 

aT(2 

U(    38) 

AT(1) 

AT(2) 

Uif    39) 

ATM) 

AT(2) 

u(  ao) 
ATrr 


AT    2 


=  AT 

=  -2 

=  -2 

=  AT 

=  -2 

=  -2 

=  AT 

^ 

=  -  z, 

=  -2 

=  AT 

=  -2 

=  -2 

=  AT 

=  -2 

=  -2 

=  AT 

=  -2 

=  -  2 

=  AT 

=  -2 

=  -2 
***** 


3USf  00 

13Ef  JO 

35E^30 

JL*xr  J) 

15E<-30 
35E+3  0 

J)*XiJ) 

152*00 

36E<-00 

JL*Xi  J) 

17E+J0 
37E4-00 

J)  *xr J) 

18Ef00 

37E+00 

J)  *XiJ) 

19Ef50 

33E*D0 

J)  *Xi  J) 

20E+30 
38Ef  00 

J)  *Xi  J) 

20E+J0 
39EfOO 

J)  *Xf  J) 
21Ef30 
39Ef 00 

J)  *Xi  J) 
21S<-J0 
3  9E+00 

J>*XiJ) 

22Ef30 
39E+30 

J)  *Xi  J) 
22E<-00 

U0E<-D0 

J)*XiJ) 

22E*(30 
UOEfDO 

J)  *Xf  J) 
23S<-J0 

U0E*30 

**************«:*************************** 
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